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ABSTRACT 


A new adaptive control law for mechanical manipulators that maintains uniformly good 
performance over a wide range of motions and payloads is developed. This control strategy 
combines properties from both the Model Reference Adaptive Control and the Self Tuning 
Regulator Theory and serves to extend the Adaptive Model Following Control approach 
into using a nonlinear reference model. 

The design procedure is simple resulting in an overall system which is globally stable 
and offers itself to microcomputer implementation. The effectiveness of the approach is 
demonstrated on several computer simulations which compares its performances against 
some of the commonly known adaptive control techniques. 

Also presented is a comparison of the computation complexity of different methods used 
in deriving the dynamic equations of motion of a mechanical manipulator as well as a 


survey of various robot control methodologies available in the literature today. 
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I. ROBOTICS : AN OVERVIEW 


A. INTRODUCTION 
The 1980's may easily be characterized as the robotics era. The last five or six years 
have experienced very strong social and economical demands for advanced automation in a 
fast expanding domain of applications ranging from the—well established car—making 
industry to unmanned underwater workstations [1]. Moreover, there is a widespread feeling 
that it 1s likely that robots, in the years ahead, will become crucial agents of industrial 
change, transforming production processes and affecting everyday lives [2]. Confronted with 
these facts, we are led to wonder about the reasons behind experts attaching such heavy 
weight to robotics and about the characteristics that make the industrial robot such a 
powerful tool. 
An answer to these questions may be found by tracing the origins that tie robotics to 
automation. Roughly speaking, we can identify three types of automation [3]. 
]. Continuous process controls 
This type of automation is used in oil refineries. It employs mostly computers with 
no, or little, human intervention. This type is highly automated. 
2. Hard automation 
Hard automation uses mainly transfer conveyor methods to handle the high volume 
mass production. This type of automation is based on setting up specific assembly lines 
with special tools and gadgets. This implies that hard automation relies on hardware which 
cannot be easily changed, should a change in the design of a product be called for. 
3. Flexible automation 
Flexible automation handles low volume batch production. Because this type aims at 


overcoming the limitations of hard automation, it is also referred to as programmable 


automation. This kind of "machine" is designed to be flexible and to be able to react to its 
environment in an adaptive fashion. This is clearly different from the conventional machine 
which can be used only for well—defined, specialized, and preappointed tasks. The 
mechanical manipulators used in industrial applications fall into this category. However, 
even though a considerable progress has been made in introducing robots into industrial 
situations, there is still more to learn both in overall concepts and practicalities before a 
robot having a performance comparable to humans can be built [4]. 

The next section will describe what is meant by a "mechanical manipulator", in 


general, and will outline some of its characteristics. 


B. A MECHANICAL MANIPULATOR: DEFINITION AND CHARACTERISTICS 

A robot is a computer—controlled mechanical device that can be programmed to 
automatically move objects through different configurations in space. Robots are normally 
constructed as series of coupled rigid links, which together constitute what is called a 


kinematic chain. There are two types of kinematic chains [5]: 


1. The linkage or the closed chain, where every link is connected to at least two other 
links in the chain. 


2. The manipulator or the open chain, where some of the links are connected to only one 


other link. The articulated portion of most industrial robots is an open kinematic chain 
with some form of end effector attached to the final link. 


A typical industrial robot is shown in Figure 1.1. The coupling of two adjacent links is 
referred to as a kinematic pair or joint. The most frequently encountered pairs in current 
industrial manipulators are the revolute or rotational joint and the prismatic or translation 
joint. These pairs are shown in Figure 1.2. The revolute and prismatic joints are single 
degree of freedom pairs. Any manipulator must have at least six degrees of freedom to 
enable it to achieve arbitrary real—world configurations. Thus, most industrial robots are 


constructed of exactly six links. The first three degrees of freedom are generally referred to 





Figure 1.1: Atypical industrial mechanical manipulator 





Prismatic joint 


id "6 
ae oie 
° 
- 
e 
® 
* ° 
° 
. 
e 
° . 
Ug 1 
‘ 
t 
' . 
i 
x 
* 
* * 
° 
° 
} . 
° 


Revolute joint 


Figure 1.2: Arevolute and a prismatic pairs 


as an arm subassembly. They are used primarily to position the wrist unit at the 
workpiece. The final three degrees of freedom are referred to as the wrist subassembly, 
subsequently employed to orient the tool according to the configuration of the object [6]. 
This research is mainly concerned with the arm subassembly. The orientation of the tool 


will not be considered. 


C. ROBOTICS APPLICATIONS 

Mechanical manipulators are widely used in manufacturing and assembly tasks such as 
material handling, spot and are welding, parts assembly, paint spraying, loading and 
unloading numerically controlled machines, and in handling hazardous materials [7]. 
Furthermore, it is now common belief that robot systems can be used in areas other than 
assembly tasks. Perhaps the most unusual application, to date, can be found in Australia, 
where a robot is used for sheep shearing [8]. Another application of robots is in space 
technology. The installation in the Space Shuttle Columbia of a remote controlled 
manipulator to place satellites into orbit and retrieve them when they fail is just one 
example [9]. Mechanical manipulators have also been used extensively in undersea research, 
probably even more frequently than in space; the latest example being the robotic unit 
used in the discovery of the Titanic [10]. Robot systems could also be used in hospitals to 
help paralytic people or those who must be in bed after surgery. The household robot is 
another dream. Military applications are also appealing. However, until all the control 
problems are overcome, the domain of applications of robot systems will remain limited. 


This will be discussed later, but, for now, a typical structure of a robot system is presented. 


PoeenoCEORE OF A TYPICAL ROBOT SYSTEM 
As illustrated in Figure 1.3, a robot system is, functionally, made up of four interactive 


parts [11]. These different parts are: 
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Figure 1.3: Ageneral structure of an adaptive robot 





1. The mechanical manipulator 
The mechanical manipulator, itself, or the plant, is an open chain of rigid links of the 
type previously shown in Figure 1.1. This is the part of the machine designed to perform a 
specific task. Each link is powered by an actuator which physically moves the link in 
accordance with some prescribed control law. The joints are usually equipped with sensors 
to allow for the relative positions of the adjacent links to be measured. 
2. The environment 
The environment in which the robot operates is the physical universe surrounding the 
mechanical manipulator. It includes not only geometrical considerations, but also the 
physical laws governing this universe, the medium in which the robot is immersed and their 
effects on the movements of the robot. Moreover, the robot payload changes constantly 
either by handling parts of different masses or changing tools and configurations from one 
task to the other. This modifies the mass and inertia of the robot, which in turn affects its 
dynamic behavior. These changes must be taken into account in the formulation of the 
dynamic model of the mechanical manipulator. 
3. The task 
The task to be carried by the manipulator, or the trajectory planner, may differ from 
one application to another. In most cases, however, the ultimate task is driving the end 
effector of the manipulator to a desired position in the workspace. Naturally. this position 
is expressed in cartesian or world coordinates. Theoretically, the task might be 
accomplished in any fashion, as along as the tool reaches the final desired position and 
remains there. More realistically, the robot must meet certain requirements in performing 


its task [12]: 


1. The motion must be as fast as possible, otherwise, the use of robots would not have 
been efficient. 


2. No overshoot of the final position is allowed to prevent damages to the environment. 
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3. The mechanical manipulator must be able to avoid obstacles that may be present in its 
workspace. 


4. The motion must be smooth, in order to avoid the increased wear on the mechanism 
and the resonances caused by vibrations due to rough and jerky motions. 


Therefore, stating the initial and final conditions alone is not a sufficient task 
description. In most cases, it is necessary for each link to follow a prescribed trajectory in 
terms of position, velocity, and acceleration at each instant of time. The desired trajectory 
can be made by the combination of any smooth functions joining the initial and final 
positions and satisfying all the constraints. Cubic functions are among the most commonly 
used trajectories since they are easy to generate [13]. 

4. ‘The controller 

The controller gencrates the control signals that excite the corresponding actuators to 
produce the torques necessary to maintain a prescribed motion of the arm along the desired 
trajectory. The control strategy is determined according to both the control task and the 
mechanical manipulator equations of motion. It 1s, however, usually derived on the basis of 
a trajectory expressed in joint coordinates. Therefore, a transformation from world 
coordinates to link coordinates must be performed before the signals sent by the trajectory 
planner can be used by the controller. 

In practice, the four functions described above closely interact with each other. When 
in operation, the computer receives, at each instant of time, information concerning the 
robot and information concerning the environment. By using this information in 
conjunction with the control law, it causes the manipulator to move toward the correct 
execution of the task assigned to it. 

This thesis addresses the design of control systems in order for the manipulator to 
adapt to a changing environment, as described by functions 2 and 4 above. The next 
section defines in more detail the mechanical manipulator control problem and addresses 


some of the difficulties. 


BE. 2HE ROBOT CONTROL PROBLEM 

Robotics, while bringing together many well established fields of engineering, is 
relatively a new science in itself. It still suffers from many unsettled points. Controlling the 
robot system to perform in certain way is one of its most challenging problems due to the 
fact that these systems are highly nonlinear. A formal statement of this problem is not, 
however, as difficult as trying to find a satisfying solution for it. In general terms, the robot 


control problem can be formulated as follows: 


Given a desired trajectory generated by the trajectory planner and a mathematical model 
of the mechanical manipulator and its interactions with the environment, find the control 
algorithm which sends torque commands to the actuators in order to cause the desired 
motion to be realized. 


One may now recognize that the robot control problem as stated here is basically a 
stability problem, along the given trajectory. 

Mechanical manipulators may be modeled precisely enough, since their behavior is 
described by the known laws of mechanics [14]. This knowledge should be used in the 
control synthesis as extensively as possible. As stated earlier, this problem is extremely 
difficult because the robot systems are inherently characterized by nonlinear dynamics that 
include nonlinear couplings between the variables corresponding to different motions. 
Furthermore, the dynamic parameters of the manipulator vary with position of the joint 
variables, which themselves vary in time and with respect to each other. These difficulties 
make the implementation of real time dynamic control computationally impractical in 
today's computers. Therefore, one of the intriguing questions arising in the solution of the 
control task is to what extent one should take into account real robot dynamics in control 
synthesis. 

Current industrial practices, in order to take advantage of the well-established linear 


systems and control theory, model the manipulator as a chain of constant—parameter, 


uncoupled linear subsystems. These design procedures, which may be referred to as the 
servomechanism control methodologies, while yielding satisfactory performances at low 
speeds, have proven to be inefficient for faster and more accurate robotics applications [15]. 

Recently, more researchers have turned to adaptive control in an attempt to be able to 
take advantage of the full robot dynamics and to overcome the limitations of the actually 
available practices [16,17]. These new approaches may be referred to as adaptive control 
strategies for mechanical manipulators. However, no completely acceptable answer has 
been given to the question of how to use the knowledge of the robot dynamics to synthesize 
such control that would be simple enough to implement in practice and to guarantee 


satisfactory system behavior. Several other problems remain [18], such as: 


1. The lack of adequate sensors for the acquisition and pre—processing of information 
received from the environment, particularly visual information. 


2. The state of development of overall theory is not yet fully developed; and, 


3. The slowness of the computations involved. 


The first problem is more of a technological problem than theoretical one and will not be 
dealt with in this context. The last two problems are inherently related to the robot control 


problem and will constitute an important part of this research. 


F. LITERATUREREVIEW 

This section presents some of the most representative solutions to the mechanical 
manipulator control problem as of today. The main difficulty, however, in trying to review 
the literature, is that different approaches have been developed for different classes, types, 
configurations, and purposes. We will primarily consider the approaches to the control 
synthesis for industrial manipulators. We will also restrict ourselves to dynamic control 
which takes into account dynamic effects of the robotics system. Control strategies both in 


terms of open loop and closed loop control have been examined [19]. 
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1. Open loop control systems 

In this case, the trajectory is preplanned or prerecorded and the input torques do not 
depend on link position and/or velocity measurements. The performances are defined in 
terms of desired cost minimization criteria. 

Along these lines, Kahn [20] has considered the time optimal control problem, 
Whitney [21] has studied the minimum energy trajectories, and Young [22] has been 
interested in minimizing a quadratic function in acceleration. 

Due to the highly nonlinear model of the manipulator, numerical solutions only can 
be obtained and stored in memory. In general, this yields a control which is optimal 
provided the system is not affected by unexpected disturbances. Also the open loop 
approach leads to schemes which are very sensitive to parameter variations. Disturbance 
rejection and position tracking can only be achieved through accurate mechanical design. 
The performances of the systems are limited by the capabilities of the actuators and by the 
vibrations induced in the mechanism by the excitation of high frequency structural modes. 
The on-line implementation of such control laws is very involved and might demand a 
rather complex multiprocessor. 

2. Closed loop control svstems 

These feedback control strategies are derived either through well known classical 
servomechanism procedures, or through more recent adaptive control techniques for their 
ability to account for parameter uncertainties. 

a. The servomechanism approaches 

Kahn and Roth [23] have proposed an approximated optimal law which, for a 
particular robot, has resulted in response times and trajectories reasonably close to the 
optimal solutions. For more complex manipulators, however, this solution might be 
unacceptable. Furthermore, the controller proposed in [23] is based on a bang bang 


approach. often unacceptable due to continuous chattering of the joint actuator's signals. 
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Vukobratovic and Stokic [24] addressed the more general problem of designing a 
controller which yields desired tracking while, at the same time, minimizes an appropriate 
cost criterion. 

Because of analytical and computational complexity, approaches by optimal 
synthesis have been developed for positional control problems only. To solve the problem of 
tracking a prescribed trajectory, Popov and co—authors [25] introduced an alternative 
approach which consists of calculating, off line, the nominal trajectory by some optimal or 
suboptimal procedures and then following the obtained path. 

The design of control systems based on the exact nonlinear model of the 
manipulator, in general, vields algorithms not suitable to real time implementations. For 
this reason, controllers based on linearized models in the neighborhood of operating 
conditions have been introduced. This, however, guarantees the stability of the linearized 
model only. Instabilities might occur in the actual system due to nonlinearities in the 
mechanism, coupling between different joints, or parameter variations. In order to 
overcome this major difficulty, several additional compensation schemes have been 
proposed [26,27] at the expenses of added complexity. 

In a different context, Paul [28] has investigated the so called inverse problem 
technique (also named the computed torque by Bejczy {29]). This approach uses the desired 
position, the desired velocity, and the desired acceleration to compute the driving torques. 
The main drawback of this scheme is that the computation of the complete nonlinear 
dynamic model is required. Simplifications have been obtained by Paul [30], Bejczy [31], 
Raibert and Horn[32] by omitting some of the terms in the model. These simplifications, 
while reducing the computational complexity, are still not enough for real time 
implementation of any control strategy based on this technique. 

Vukobratovic and Stokic (33] have recognized that the forces (moments) acting on 


the robot joints can be directly measured and used to synthesize a feedback law that 
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compensates for the coupling in the robotics manipulator and relieves the controller from 
on line computation of these complex terms. Other attempts to include force feedback 
control account for the work of Hewit and Burdess [34] who introduced force transducers in 
the joints of the manipulator. Although the computation time is shorter, their scheme is 
still too complex for real time implementation. Wu and Paul [35] implemented an analog 
force feedback loop on a single joint manipulator which avoided the computational 
difficulty. Luh, Fisher, and Paul [36] have analyzed the effects of linear independent joint 
torques control. The stability of the overall system, however, has not been discussed in any 
of these papers. There were other attempts to use force feedback, not only at the executive 
control level but to include assembling tasks, such as in the resolved motion control 
introduced by Whitney [37]; the resolved acceleration control by Luh, Walker, and Paul 
[38]; and the resolved force control by Wu and Paul [39]. 

The simplest and most widely used control method today is based on decoupling 
and joint control. Yuan [40] tried to dynamically decouple a manipulator by linear control. 
An effective analysis of a constrained linear control may be found in Golla, Garg, and 
Hughes [41]. Freund [42] attempted the decoupling by nonlinear control involving full state 
feedback which guarantees stability in the absence of external disturbances. Young [43] 
developed a variable structure controller for manipulators. 

b. Adaptive techniques 

In addition to the computational complexity, the servomechanism approaches 
cannot always satisfy the stability conditions even if designed to be robust with respect to 
parametric and state disturbances. Adaptive control methodologies aim at overcoming 
these difficulties. 

Within the adaptive control theory, two fundamental approaches exist in the 
literature [44]. The first is the Learning Model Adaptive Control (LMAC), in which an 


improved model of the plant is obtained by on line parameter estimation techniques, and is 
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then used in the feedback control. A general structure of this approach is shown in Figure 
1.4. The estimated model and the controller may be either linear or nonlinear depending on 
the estimation technique used. The well known Self Tuning Regulator method belongs to 
this class. The second approach in adaptive control theory is the Model Reference Adaptive 
Control (MRAC). The controller is adjusted so that the dynamics of the closed loop system 
matches that of a preselected model. A general structure of this methodology is given in 
Figure 1.5. In general, the reference model is chosen to be a stable, linear, time—invariant, 
decoupled system. The controller may be either linear or nonlinear. It is also possible to 
design adaptive schemes which combine both techniques. 

Many different structures of self tuning regulators are available in the literature, 
and they differ in parameter estimation technique and control algorithms [45]. Koivo and 
Guo [46] examined the feasibility of least squares techniques to robotics applications. Their 
approach is configuration dependent and does not account for nonlinearities in the system. 
It is based on estimation of the linearized dynamics and does not take advantage of any a 
priori knowledge of the system that might be available to the designer. Elliot, Depkovich, 
and Drapper [47] gave an extension of this method to the nonlinear case taking advantage 
of the fact that, in spite of their nonlinear nature, the parameters in the dynamic equations 
of a robot system appear linearly. This method showed better tracking ability, but did not 
solve the computation complexity. Cristi, Das, and Loh [48] exploited this idea of linear 
parameterization of the dynamic equations to give one of the first attempts to formulate an 
adaptive version of the computed torque technique. Their scheme consisted of an on line 
loop to estimate the payload and an off line loop to estimate the other parameters of the 
manipulator. The good feature of this approach is that it guarantees global stability of the 
system. In similar fashion, Craig, Hsu and Sastry [49] proposed another adaptive computed 
torque controller version, based on linear parameterization of the dynamic equations, and 


have established global convergence for their scheme. This method assumes no a prior! 
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knowledge about the system and requires acceleration measurements, which makes it 
numerically complex. Middeleton and Goodwin [50] gave an extension of this method based 
on position and velocity measurements only. This method is still complex for real-time 
implementation. Lee and Chung [51] exploited the self-tuning regulator structure by 
introducing the adaptation at the level of linearized perturbation equations in the vicinity 
of a nominal joint trajectory. Their approach uses the recursive Newton—Euler equations 
for feedforward computation of nominal control and a recursive least squares, one step 
ahead control for feedback corrections about the nominal trajectory. The number of 
computations involved is reduced. However, this method can only compensate for small 
deviations. An attempt to speed up this method by avoiding the use of the Newton—Euler 
recursion was performed by Vukobratovic and Kircanski [52]. Their scheme is based on 
local adjustable controllers at each joint. The controller consists of a nominally tuned 
feedforward PID structure, and a feedback corrective portion to account for parameter 
variations. This method relaxes the computational burden by introducing a computer for 
each link, instead of one main computer for the whole robot system. 
There are four basic approaches to the design of Model Reference Adaptive 

Control Systems {53}: 

1. Local parametric optimization theory 

2. Lyapunov functions 

3. Variable structure systems 

4. Hyperstability and positivity concepts 

Within the local parametric optimization techniques, Dubowsky and DesForges 

[54] used the steepest descent method to develop one of the first contributions in adaptive 
control for robot manipulators. This method is computationally less burdensome and has 
good noise rejection properties. However, the steepest descent algorithm, while it can yield 


better adaptation speed. calls for many simplifications and may negatively influence the 


1 


overall stability of the manipulator. The input signal may also become excessively large 
due to the fact that only the output error 1s minimized. The discrete time version of this 
method [55], as well as the multivariable case [56], have also been developed by Dubowsky. 
The later approach was tested on an industrial robot and showed the significance of 
adaptive control in high speed tracking operations. 

Takegaki and Arimoto [57] have considered the applicability of model reference 
adaptive control theory in robotics, using the Lyapunov function approach. Their scheme 
included a nonadaptive gravity compensation loop. This resulted in simple adaptation and 
control laws, thus making it suitable for real time implementation. However, how the 
eravity compensation loop affected the tracking quality could not be shown. 

Young [58] combined the variable structure theory with the model—following 
approach and investigated their use in robot positioning problems. This approach also uses 
less computation. It, however, uses the hierarchical control methodology of Utkin [59], 
which may not be valid if only asymptotic convergence can be reached. In addition, the 
control signals are discontinuous and the high frequency components may become 
unacceptable. This method suffers also from the fact that there are no design procedures for 
tuning the controller parameters. Slotine and Sastry tried [60] to remove some of these 
difficulties by using the concept of time varying sliding surfaces in the state space. They, 
however, trade off accuracy against chattering by approximating the obtained 
discontinuous control law by a continuous one. 

Horowitz and Tomizuka [61] presented one of the first attempts to apply 
hyperstability theory to robotics. Their algorithm has been later implemented on a three 
degree of freedom manipulator by Anex and Hubbard [62] after been slightly modified to 
compensate for gravity. The advantage of this method is that the adaptation mechanism is 
derived from the condition of overall system stability. Its main problem is the fact that the 


dynamical effects are estimated without using any a priori knowledge about the system 
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dynamics. In practice, many of the robot parameters are known and it would be convenient 
to estimate only the unknown ones. The application of hyperstability theory to robotics 
models has been fully developed by Balestrino, De Maria, and Sciavicco [63]. Their strategy 
offers better transient behavior compared to that with self-tuning regulators and it 
guarantees stability of the entire system. The main drawback of this method is the 
possibility of excessive control signals and its high numerical complexity. 

As a conclusion, let us note that adaptive methods for manipulation robot are still 
in their early stages of development. It is, therefore, very difficult to produce an exhaustive 
survey of these methods as new design ideas continue to appear in the literature. So far we 
have summarized some of the approaches available, far from a complete treatment of the 


problem. 


eee ols OU PLINE 

The remaining of this research will be centered around the development of adaptive 
control strategies applied to robotics systems. Fundamental to the problem of dynamic 
control, the derivation of the dynamic equations of motion will be addressed in Chapter 
Two. Different approaches to obtaining these equations. as well as their computational 
complexity will be discussed. 

In Chapter Three. a new adaptive control law which will combine properties from both 
the STR technique in [51] and the hyperstability principal in [63] will be presented. This 
methodology has the advantage of assuring global stability and aims at overcoming many 
of the limitations of the previously studied schemes. It makes use of a nominal dynamics 
feedforward compensation loop, but, unlike Ref.[51], the stabilizing feedback loop does not 
call for any simplifying assumptions. A rapprochement between this method and the 
AMFC will be established, but, unlike Ref.[63], it does not require excessive actuation. 


Most of all, our approach yields better performance and is numerically very efficient. 
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I]. MECHANICAL MANIPULATOR DYNAMICS 


A. INTRODUCTION 

In order to design a controller of an articulated mechanical system, it is necessary to 
have a mathematical model the system. This model expresses the relationships among 
different components of the robotics system and the interactions between the mechanical 
manipulator as a whole and the physical universe surrounding it. It is described in terms of 
characteristic variables which are specific to the system, such as degrees of freedom, 
lengths, masses, inertias, positions, forces, and torques. 

The number and nature of the parameters used in each model depend on the application 
and the accuracy required. The designer is constantly faced with the challenge of 
developing models that adequately represent the dynamics of the system, and that are 
computationally convenient for computer implementations. 

Because of the high speeds required in any future robotics application, dynamic 
phenomena, such as frictional, inertial, centrifugal, and coupling forces should be taken into 
consideration for the chosen model to be representative of the actual mechanical 
manipulator behavior. 

An efficient mathematical model of a robot is essential for both design and control 
purposes. In the design phase, a complete dynamic model is useful for determining loads, 
dimensions, tolerances and actuation. In control applications, the dynamic model is used to 
generate the nominal joint torques as well as to simulate and test control strategies without 
the need of building a prototype (at least in the early stages of the design). 

There are two problems related to the dynamics of a manipulator. In the inverse 
dynamics problem, we are given a trajectory in terms of joint coordinates q(t) and their 


derivatives, q(t) and q(t), and we wish to find the corresponding sets of vector torques T. 
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This formulation is at the basis of the control problem. The second formulation is the 
direct dynamics problem. In this formulation, we wish to calculate the resulting motion of 
the manipulator q(t), q(t) and q(t) for every given set of vector torques 7. This is at the 
basis of the simulation of the robotics system. 

There are several possible approaches one can take to derive the dynamics equations of 
an articulated mechanical system. Newton—Euler's equations, Gibbs’ functions, 
d'Alembert's formalism, Bond graphs and Lagrange equations are only few of these 
methods. 

Lagrange and Newton—Euler equations are, however, the most frequently used in the 
literature. In this chapter, we will present several alternative formulations of these two 
methods. address their computational performances, and show that one can easily be 


derived from the other. 


B. CLOSED—-FORM LAGRANGIAN MANIPULATOR DYNAMICS 

This formulation was first applied to open loop kinematic chains by Kahn [64] from the 
more general linkage problem of Uicker [65], and has served as the standard manipulator 
dynamics for over a decade. We begin this derivation by presenting the notation used 
throughout the development. 

The links of a manipulator are numbered consecutively from 1 to n starting from the 
base to the tip. By convention, the reference frame is numbered as link 0. The joints are 
numbered so that the joint 7 connects link 2-1 to link 2. An orthogonal coordinate system is 
fixed in each link as follows: 

z,is directed along the axis of joint 7+1, 


z, lies along the common normal from z,_, to z,, and 
y; completes the right handed coordinate. 


ask 


The relative position of two adjacent links is completely described by: 


a the distance between the origins of coordinate systems ¢#-1 and 7 measured along z,, 
s,, the distance between z, | and z, measured along z,_,, 


a,, the angle between the z,_, and z; axes measured in a righthand sense about z,, and 


Vip 
! 
)., the angle between the z,_, and z, axes measured in the righthand sense about z,_.. 


This notation is summarized in Figure 2.1. If the joint is rotational, the joint variable will 


be 0 if translational, the joint variable will be S.. The symbol q, will designate the 
4) 
49 
variable for joint 2 whether it is S. OF @ The vector q = |: | represents the generalized 
Gn 
coordinates of the manipulator and completely specifies its position. In the subsequent 
development, lower case and uppercase regular letters will be used indifferently to 
designate scalar quantities, lower case bold letters to designate vectors, and capital bold 
letters to designate matrices. Subscripts refer to the physical location of the variable, 
superscripts to the coordinates frame the variable is expressed in. Either of these is omitted 
when referring to the base coordinates frame. 
The Lagrange equations for a nonconservative system are: 


d dL OL 


— —-—=7., 
tog ag, 


2 


= eee (Dash) 


where, 
L = k —P is the Lagrangian function, 
K is the total kinetic energy of the manipulator, 
P is the total potential energy of the manipulator, 
q, is the generalized coordinate of the manipulator, 
q, is the first time derivative of the generalized coordinate, and, 


T is the torque applied to the system at joint 2. 











; 
C3 
| Link ji 
ae 

ee ed 
Link i-1 
ge. 
lie i 


Figure 2.1: The standard axes definitions for connected links 
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To find the kinetic energy of the physical system, we need to know the velocity of each 
OR 
Y; 


joint. Let p, = | z, h 
1 


denote the coordinates of link i in the reference frame of the i” itaele: 


i] 1 
Hi |e 
0001 

the homogeneous coordinate transformation which relates the displacement of the jth link 
th 
) 


Pp, the same point P, with respect to the base coordinates frame; T 


coordinate frame to the (?-/ link coordinate frame; and T, the coordinate 
transformation which relates the ifn coordinate frame to the base coordinate frame. The 
rotational transformation ee and the translational transformation ve are given by: 


cos. — sin@, cosa, sind, sina, 


i] 
Ri =| sind, cos, cosa, —cosé, sina, (2.2) 
0 sina, cosa, 
and, 
ae) cos @; 1 for a revol ute joint 


Now pa,sind. |, p= | a. (2233) 
0 for a prismatic joint 


Ss. 
2 


The variables p | and P, are related by: 


p,= Tp, (2.4) 
where 
O al Vat! : 
Woe pel, (225) 
Assuming rigid body motion, all the points P, will have zero velocity with respect to the 
ifn coordinate frame. The velocity of P, expressed in the base coordinate frame is: 
7; 
Yi} d dja 
Ya. | ari P,) = al fp, (2.6) 
0 | 
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Since pis =e); v, can be written as: 


v=) ma Pi | (2.7) 





j=l q 
where 
ary =| 
F =a, ’ (2.8) 
4 
and 
aT, | TY TY -THTO,TE.TE, for j $i 
45 0 on 
eee) 
The matrix Q, being: 
7 Pea Gai — 0 Or. 
4 4 ; : . a revolute joint 
Simo Ole (2.10) 
0000 p=Veand =) fOr 


a prismatic joint 


Oh ie 
In order to simplify notations, let us define Us = —\ then equation (2.9) can be 
@) 


qj 


written as follows: 


] hae 
Tey Q,T; OTe at 
oe . = 1,2,....n (2.11) 


) 
0 LOT je 


Using this notation, v, can be ~ as: 


-[) U;-4)|P (2.12) 


jel 








The matrix Ui, is the rate of change of the point p, on link 7 relative to the base coordinate 


frame as q, changes. It represents both the linear and angular velocities of the link. 


The kinetic energy of an infinitesimal mass dm on link 7 is found as: 


i a RY a 
dk, = 5 (x; + y; +f- z-)dm 
] 
dk. = 5 Tr(v, vi)dm (223) 


where a trace of an nxn matrix A is defined as: 
n 
Tr(A) = ) a. 
| 


Substituting equation (2.12) for Vi the kinetic energy of the infinitesimal mass becomes: 








ys 
eo ee ee 
dk;=gTr} ) ) U,(pidmp; 1884 (2.14) 
eal 
For the whole link, 
k= [falk. 
it 
eZ eos a: : 
K;=—y- Tr] ) ) Ulf p;p; nat (2.15) 
Ne k=) | 
The integral term inside the bracket is known as the pseudo inertia matrix J, of all the 
points on link 2 with respect to the proximate joint of link 7 expressed in the ifn link 
coordinates system. 
1. (toe 
J,=Jfpjpj am 
J 22dm Jry dm fr.z.dm Jz .dm 
jiL jz.y dm Jy2dm Jy,2 dm Jy ,dm (2.16) 


i Juz .dm fy.z,dm J2’dm Jz dm 
Jx.dm Jy dm Jz.dm {dm 


The inertia tensor I of link 7 about its center of mass in the jth coordinate frame is 
defined as: 
i, 2 
Ly 7 : bu, ) a 7 rz, }am 
k 


h 


where the indices u,v,’ indicate principal axes of the it coordinate frame and Oy is the 
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2—D Kronecker delta. The pseudo inertia matrix J can then be expressed in terms of the 


, : 1 
nsor I 
inertia tenso " as 


1 1 1 
Tt yy tle 1! I i ae 
ry 2 ace 
je —y' cal 
; 1’ ee ee I : my 
J, = vy 2 ee: (Oat) 
: 1! al, aie 
I I SS eae 
yz 9 ime 
aC Miye | Bose EF 
2 1 1 
me, 
where c, = eee tat s the center of mass vector of link 2 from the 2 th link coordinate frame 
e. 
] 


and expressed in the ifr link coordinates system. 


The total kinetic energy k of the manipulator arm can be expressed as: 
n 
K=) K, 
— 
Cee 
1 ele 
=5) ) } Tr(U;, FU 4,44] an) 
| SS) 
Note that the terms J, are dependent on the mass distribution of link 2 and not on their 


position or rate of motion. Hence, the J need to be computed only once for evaluating the 
kinetic energy of the manipulator. 
The potential energy P, of the link 2 is: 
=e. a 1 
P. = HED. = mglT pi (2.19) 


where g = [ g 0] is the gravity row vector expressed in the base coordinate system. 


A ie By 8 - 
The total potential energy of the manipulator then becomes: 


Zi 


n n 
= oe } 
Ps) Pos > mg|T (2.20) 
—- i=] 
and the Lagrangian function L then becomes: 
n 1 n | 
= ) 
“}) J Lfmwastudaaj+t maine] ean 
—— —) i=1 
Performing the differentiation in the Lagrange equations and rearranging, we obtain the 


necessary generalized torque T. for joint 2 actuator to drive the ifn link of the manipulator. 


7 = GOL OL 
; dt 0q - Oq: 
i i 
nr x 
d A 
iin Te(U, IHU, Jat YY Y MO, 34 Uy Yar dS 
A= A= tho 1 =i 
Te aang 
(2.22) 
The above equation can be expressed in a matrix notation as: 
n n n 
Pa) a )) ) Gatnin e. SlB oe (25) 
k=) hid 
Or in more compact form as: 
r(t) = Afa(t)}a(t) + V[a(t),a(e)] + G[a(s) (2.24) 
where 
! 
E 
r(t) = |:7] is an nxl generalized torque vector applied at joints i=1,2,...,n, 
if 
n 
4 
q(t) = |:?] is an nxl vector of the joint variables of the manipulator, 
q 
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q 
q(t) = |:?] is an nx] vector of the joint velocity of the manipulator, 
q 
n 
S 
P le ae 
q(t) = |:°] is an nxl vector of the acceleration of the joint variables, and 
q 


n 
Ala(t) is an nxn inertial acceleration related symmetric matrix whose elements are: 
n 
= WEN ic 
a. = : Tr(U) ,J\U, ,), i eee (2.24) 
A=max(7,k) 
meen %=Kk, a is related to the acceleration of joint 7 where T, acts and is known as 


effective inertia. When ?#f, a sp is related to the reaction torque induced by the acceleration 


of joint k and acting at joint 7 (known as coupling inertia), and 


V|a(t).a(t) = |:*] is annxl velocity related vector composed of Coriolis and 
v | centrifugal forces, where 
n 


mn on 
See) Vt Oe Pee (2.25) 
k=11=1 
and 

af 

ee A he 

c= ) Tr(U, ,J4 Uy ,) , £4 =1,2,.... (2.26) 
A=max(1,k) 


When A=/. the velocity torques are known as centripetal torques, and when k#/ as Coriolis 
torques. Friction torques are also velocity related and can be added to this term as: 

fr =Csgn(q,) + Va, 
where 


C is a coulomb friction constant, 
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V is a viscous friction constant and, 


sgn is the sign function, and 


Gla(s)] = 5 is an nxl gravity loading force vector, where, 
g 


n 


g.=- ) mye, DP} Con 
i 
The dynamic equations of motion as given by equation (2.24) are coupled, nonlinear, 
second order, ordinary differential equations. Notice also that equation (2.24) yields the 
solution of the inverse dynamics problem. For every point (q(t),q(t),q(t)) of a given 
trajectory, it yields the required joint torques vector 7. This form allows design of a control 
law that easily compensates for the nonlinear effects. Computationally, however, these 
equations are extremely inefficient as they require: 
A (A8)n'* + 25*)n° at Cols + (yn multiplications, and, 
2. (2) ne (yn? -- (M54 ieee (35 n additions. 
for every set point in the trajectory. That is, they are of O(n*) order of complexity, where 
nis the number of links. 
There are two categories of approaches in trying to implement the closed—form Lagrange 


equations in real time control applications: 


1. ying the dynamics by ignoring the least significant terms and correcting errors 
with some feedback compensation. The simplifying assumptions, however, may not hold 
for all speeds and all ranges of applications. 


2. Precomputing terms in the equations and using a gain scheduling approach. 


C. RECURSIVE LAGRANGIAN MANIPULATOR DYNAMICS 
The main reason for the inefficiency of the Uicker/Khan formulation is due to the fact 


that these equations are closed-form expressions and most of the terms are reevaluated 
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many times. To reduce the complexity of these equations, we need to reexamine the above 
derivation and recast it into a recursive form which is computationally more efficient [66]. 


The generalized driving torques given in equation (2.22) can be expressed as: 


n 
Na 
where T , is defined as: 
d Aen 
) Uypit 2) VygAndy (2.29) 
k=1 | meth a | 


The advantage of the above substitution is that equation (2.29) is never used in the 
computation. More efficient recurrence relations for the velocity Ty and acceleration Ty 


are easily derived by straightforward differentiation: 
el, 


ie 1.) eo) 
Pat T+ Ty ty 

Rat, Ty +T, Wand (2.31) 
t=, 4% a PET HT, Uy aytT,_8y4,tT py yy 

B= Ty yTY + 2b Oy + MV y aad + Tardy (2.32) 


Computing the driving torques as given by equation (2.28), and using the recursive 
relations in (2.30), (2.31). and (2.32), results in an O(n2) order of complexity, requiring: 
1. 106 sn + 620 sn — 512 multiplications, and, 
ue Son” + 5l4n — 384 additions. 
The reduction in complexity comes from the fact that to calculate coriolis and 
centrifugal forces. we only need to calculate Uy)\ instead of all the matrices Uy pp 
Further computations can be saved by pouns that: 


U =U.T, \ (2.33) 


rt 
Therefore.the generalized torques equation (2.28) can be written: 


3] 


n 
_ i Ar d 
r= J rr(u, Tiyt,) — mu, Tip, 
\—) 
n x nr 
é Soe \e: pind 
r=Tr(U,, ) T)I\T,) -— BU, ) mT iPy 
= i 
Or 
f2= = Tr(U,D,) — gU.C. 
where 
- Jan yp : 
7 
_ ply ly gitl Arn t 
D, ie ef ) Vee ae ieli 
A=i+1 
De J 4 £ igor 
and 


-t i T}P) 
o 7 md; + Tei 
These recursive relations can be computed as follows: 
P Oi? =|. 2a 
1. compute 1, by equation (2.30) 
2. compute T. by equation (2.31) 


_ compute T., by equation (2.32) 
.if 7 = n, continue. Otherwise, set 12=7+1 and return to 1. 
. compute D, by equation (2.36) 
. compute C, by equation (2.37) 


“1 OD: at oe OO 


. compute 7, by equation (2.35) 


OD 


.if 2= 1, stop. Otherwise, set 1=7-1, and return to 5. 
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(2.34) 


(2.35) 


(2.36) 


(2.37) 


The advantage of this formulation is that its complexity is now O(n). It requires: 
1. 830n — 592 multiplications, and, 
2. 675n — 464 additions. 

Any other reduction in computational complexity can only be obtained by reducing the 
size of the coefficients in the above complexity polynomials [67]. This can be achieved 
through reformulating the Lagrangian dynamics in terms of 3x3 rotational matrices rather 
than 4x4 rotation—translation matrices. Because 3x3 matrix multiplications require 27 
multiplications while 4x4 matrix multiplications require 64, we get a greater than 50% 
reduction in the coefficients of the computational cost terms. 

The matrix i relating the orientation of the coordinate system t1 and 7 is now 
reduced to a 3x3 rotation matrix Re A point on link 7, expressed in homogeneous 
7 


coordinates with respect to the jen coordinates frame, is now represented as i | 8 le 


1 
with Pp, the same point with respect to the base coordinate frame. The following sets of 


vectors are also needed throughout this derivation : 


oO), the joint 2 coordinate origin expressed in the fh coordinates frame, and, 


h 


Si the link 2 center of mass expressed in the 4 coordinates frame. 


The quantities, p., 0. and 4 are related by: 
a P; y 


p;=0, + p (2238) 
The velocity of p, is then given by: 
Pine POs Tp, (2.39) 
and the kinetic energy for a particle on link 7 is as given earlier: 
1 
dk, = 5 Tr(v.vt)dm (2.40) 
dk, = 5 Tr(6,6T + 2T poll pprTt)dm (2.41) 
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Integrating over all particles in link 2, the total kinetic energy K, of link 7 is given by: 
ae a nobay 1. om qin 
K,= 5 Tr(mool + 2T not + TST) (2.42) 
where 
en 
LS f pdm (2743) 


Therefore, the total kinetic energy for all the links is given by: 


ll -_ aoe) — 
=5 ) Tr(m,o,o} + 2T yoy + T\JSTY) (2.44) 
A=1 
and the potential energy becomes: 
n 
A 
) my8T\P) CF) 
A=1 


Proceeding as in the homogeneous coordinate formulation, we can write the Lagrange 


equations for each link as: 
— ders Ok , OP 

fae oe 

Oq, Oq, 04, 


t 


(2.46) 
2 
which take into account the fact that the potential energy depends on position only. 


Performing the differentiation and rearranging terms yields: 


00 
r= - J fran my 20f +a) ATTY+U, MLOT+U, IVT {mal py] (2.47) 
d d 


eeall clit 


0, =0,+ To, (2.48) 
A _ U0! (2.49) 
ee, 
"4 ; 
Un n= U,T, \ (2.50) 
Substituting the above relations into equation (2.47), we obtain: 
n n 
v 1. 1 Naree Leds Lave Tt? A 
7 aaa. ) (mo ,6{+o\n\ ITY +T ny of+T J, TY))—-gU,, ) myT\p\ (2.51) 
A=1 A=1 
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Or 


= Tr(U..D,) —gU..C. (2.52) 


"i ae? leet 


where 


1 vA _ i 1 
) my Tip) = mpjpt+ Ti, 1C;,, (2.53) 
1 
has the same structure as equation (2.37), except for the difference in dimensionality. For 


the term D.. we can write the recurrence: 
n 
D.= ye (m 050} — ojn are -) i not ~ Te ug 
X=! 
nN 
r iy 1+] rr ‘silly a Ne Deere reat 
D= ) ((T 341%) +04 Mmyd{emyTTP)HT) Ty (ngol+ ITY) +more 


De er. D,, n'61 + JT (2.54) 


ae Ory et | 22 
where 


m0 ~ nyYTY) 


_O 
lI 
i ea Ss 


Pee Be. atin 9 
e,=e.,,+ mot+niTl (2755) 


The T, term also has the same recursive expression as defined earlier in equation (28a 
though presently referring to a 3x3 rotation matrix. The 0, term is given by: 


——— rA-1 
OS TN (2.56) 


This formulation decreases the complexity polynomial of the recursive Lagrangian 
formulation with 4x4 matrices by more than 50%. It requires: 
1. 412n — 277 multiplications, and 
2. 320n — 201 additions. 
This translates into 2.195 multiplications and 1,719 additions, for a six degrees of freedom 


manipulator. which is well within the capacity of today's microprocessors. 
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D. RECURSIVE NEWTON—EULER'S MANIPULATOR DYNAMICS 

Another possible formulation of the equations of motion is based on the Newton—Euler 
approach. While the Lagrangian dynamics were reworked with some effort into an efficient 
recursive form, this method, naturally, yields a set of recursive equations which can be 
applied to the links sequentially reducing the computational burden to its minimum 
possible. 

In this derivation, each link is considered as a free body accelerating in space and 
obeying Newton's second law of dynamics for linear movement and Euler's equation for 
angular rotation. 

Using the same notation as previously defined, the vectors o, (joint's 2 coordinate origin 
expressed in the base coordinate frame), ie (joint's 7 coordinate origin expressed in the 
jel coordinate frame), and 0.4 (joint's (#1) coordinate origin expressed in the base 
coordinate frame) are related by: 

1 


DSO 2 O, (2.57) 


el 
If Fa and Wey are, respectively, the linear and angular velocity of the coordinate 
system (ZY; pp2j_ 4) with reference to the base coordinates, then the velocity of 


coordinate system (Z,. y,2,) with reference to the base coordinates is: 


do?! 
oe. eae (2.58) 
o> dt a eee) tol 
Thus the acceleration is given by: 
ral P 
Vea tw TT bow. 1 Xa tw (w. x0, “)+V., (2.59) 
| 
ao i-1 


9 . 1X0. i 
in which 2w, Ya is the Coriolis acceleration, w,_ 1(W 1X0, ) is the centrifugal 
acceleration and x denotes external product of vectors. 
The angular velocity of the system (Z, y,,2,) with reference to the base w, and its angular 


velocity with reference to the (1) coordinate frame we are related by: 
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er oh, (2.60) 
and 
. t] 
We=w,) + Ww, 2-61) 
But, 
diy 
tl ae 1 
Yo = Fe ee (2.62) 
Hence (2.61) becomes: 
W-=w.,t oi + w. .xwh! (2.63) 
i "el dt rl" 
Since an angular motion of link i is about the zy axis, then, 
ie z. ,g. if link 7 is rotational 
— | aa (2.64) 
0 if link 71s translational 
Thus, 
dwi | 4, th if link 7 is rotational 
i = (2565) 
0 if link zis translational 
Combine (2.60). (2.63), (2.64), and (2.65) to yield: 
w. ,+2. ,Q. if link 21s rotational 
wi=| i-1 © “t-141 (2.66) 
Wey if link 2 is translational 
and 
>. We t2,_ a,tw,_  x(z,_ ,9,) if link vis rotatat ional 
w= (2.67) 
Ww if link 7 is translatinal 


1—1 
Returning to equations (2.58) and (2.59), we note that if link 7 is translational in 


coordinates (ZY; -2,;_ 7); it travels in the direction z,_,. 


relative to link i—J. If it is rotational in coordinates (Zp Yz_ pp2;_ y)> it has an angular 


with joint velocity qj 


velocity we Thus, 


do. | wo; if link iis rotational 
ie (2.68) 
Zz, 449; if link 7 is translational 


3f 


—| ’ i—l, tel et oe 
d2o" xo. “tw. “x(w. “xo. -)if link tis rotational 
a it 1 i } 1 (2.69) 
Zz, 74, if link @ is translational 


Combine equations (2.60), (2.63), and (2.68) to yield: 


Gas Oe if link iis rotational 
js: 1—] 
‘a pal Pee eee (2.70) 
Z,0495 FO W;XO;, TV, MUNK 218 transiationa 
wexot? + w.x(w.xo? 7) + Vv. ee. 
a, ) pees: 1-/ if link 27 is 
rotational 
- Z. 4d. + eo ae + 2wx(z- ,Q-. Bi!) 
viet a pt Ee eines) ale 
[t+ w x(w xo ; ) + Viale translational 


Equations (2.66), (2.67), (2.70), and (2.71) describe the recursive relations of velocities 
and accelerations between link #1 and 12. To derive the dynamic motion of the mechanical 
manipulator from the above kinematics information, each link is considered as a free body 


accelerating in space and obeying Newton's second law of dynamics: 


d(m.v, ) 
— t ae = ’ 
| =e mide. , for linear movement, (2) 
and Euler's equation: 
a) ee | 
mamta ig ae w x(Lw,), for angular rotation (227 


where, 


i is the total external vector force exerted on link 7 at the center of mass C,, 
de, 
Ve ae iS the linear velocity of the center of mass C, of link 2, 


2 
Wve. | 
a c. = mae the linear acceleration of the center of mass Cc, of link 2, 


N, is the total external vector moment exerted on link 7 at the center of mass Ci, and 
if is the inertia matrix of link 7 about its center of mass Cc, with reference to the base 
coordinates system. 
The other variables are as defined earlier. 
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The quantities Ww, and Ww, can be computed from (2.66) and (2.67), while Vea and a, can 
1 1 
be derived from (2.58) and (2.59) as follows: 


Replace a by C, , 0; by C,, and note that since both (Z,,9,,2,) and c, are fixed on link 2, 


dot} d2o% 


1 1 
“i aoe 
Consequently, the equations describing v P and a, are: 
1 1 


eal — : 
CG: hua | 


xo! 
t 


+ Vey (2.74) 


meee ic ae 
ac. =W,)xo, - + Wp x(w x0, )+ Wi 


(2.75) 


ral 
The total external force OF and moment N are those exerted on link 2 by gravity and 


neighboring links, that is, 


F,=f,-f.., (2.76) 
ee Searcy le, me a 
-_ Se 
N,=n, tele (0, —¢,)xF,— 0, xf) (20it) 


where 
f. is the force exerted on link 7 by link :—1, and 


n. is the moment exerted on link 7 by link 7—1. 
Since Oo pu ap C., equations (2.76) and (2.77) can be expressed in recursive 


relations as 
Feet fe ae 
f. i saa i (2.78) 
= ~1 
frp CS ae 
According to the convention for establishing link coordinate systems for a mechanical 


+ (of) + ¢)xF, +N, (2.79) 
manipulator, the motion of link 2 may only be either a rotation in the coordinate system 
(ZY; r3- ) about z,_, axis, Or a translation relative to the coordinate system 
(Z;_ Y;_ 7-2;_,) along z,_,. Therefore, if the joint 2 is rotational, the input torque 7, at 


that joint is the sum of the projection of n, onto the zy axis and the viscous damping 
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moment in that coordinate system. If, however, the joint 7 is translational, the input force 
T, at that joint is the sum of the projection of f. onto the z,_, axis and the viscous 


damping force in that coordinate system. That is, 


nfz. ,+b.¢. if link zis rotational 
=| a (2.80) 
© ' {tz  +b.g, if link dis translational 


where b. is the viscous damping coefficient for joint 7. 

In summary, the complete set of equations of motion for the mechanical manipulator 
with n joints and n+1 links consists of equations (2.66), (2.67), (2.70) through (2.75) and 
(2.78) through (2.80) for i=1,2,...,.n. Unfortunately, because these equations are referenced 
to the base coordinate systems, the inertia matrix Laid dependent on the changing 
orientation of link 2, which complicates the computation. A more efficient technique for 
computing the joint input forces and torques is to have each link's dynamics referenced to 
its own link coordinates [68]. This may easily be achieved using the rotation matrix Re 


defined earlier and noting that since each coordinate system is orthogonal, then: 


_, - — 
(a 1 ees (2.81) 
Instead of computing w., Maer ,F., N, f., > and qT ee RW, RN. R'a, 
: C; 
RF. R'N : Rt. R'n, and R'r, Hence the complete set of equations of motion becomes: 
yas : ; = 
Ri (RR ‘w, ,+2,9,) if link 7 is 
a FF OE roriional 
Rw,= (2.82) 
1 1—1 emluinK age 
R;_ (R Wi_ 7) translational 
y—]. ce 1—1 
Ri {[R’ 'w. +2,9.4(R° ‘w, p)X2 q,| Oe liseli Ts 
iJ i—1 0% ts 0 rotational 
Rw. = (2.83) 
A if link 7 is 
R, (Ro w,) trans | ational 
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eas ee = 
(eR w,)x(R OF ) +R;_,(R ve_y) vanahned: 
Ietaes lel ti eeealeS 


- (R'w,)x[(R'w,)x(R'o1”’)] rotational 


RY, = (2.84) 
——— i iim! 
ere a eenernale w,)x(R 0; ) 


1 1 ; 1 
+ 2(R’w;)x(R;_ 1299, )+(Rw,) if link i is 


1 tt —1 trans! ational 
_— ame: u | | = | 
Ria, = (R'w,)x(R'c,) + (R'w,)x[(R'w,)x(R'c,)) + Rv, (2.85) 
d 
eae i 
RF,.= mR ae. (2.86) 
R'N, = (R'LR) (RW, + (R'w)x((R'LR)(R'w)] (2.87) 
Pye +1 i if 
Rf, = Ry, (R'f,,,) + RF, (2.88) 
i i+] i+] i- i+] 
Rno,=R; 1, Uk | Oe oF lee La (2.89) 
+ (R'o. +R'c4)x(R'F.)+(R’N .) 
i | (R'n TCR 179) + b,4; if link iis rotational wn 
. 2, 


(R'E )*(Ri_ 2) + bq, if link zis translational 
This formulation gives a 60% reduction in computation over the recursive Lagrangian 
formulation. It requires: 
1. 150n — 48 multiplications. and 


2. 131n — 48 additions. 


E. CONCLUSIONS 

In this chapter alternative formulations for deriving the equations of motion of serial 
link manipulators have been described. The emphasis has been put on real time 
computational complexity in terms of required mathematical operations per trajectory set 
point. One should not, however, be misled by the fact that in the above development, the 


recursive Newton—Euler equations are almost three times more efficient than the recursive 


4] 


Lagrangian equations. The discrepancy between the two formulations is due to the 
difference in the angular velocity vector representation used by each method. In the 
Newton—Euler formulation, the angular velocity is adequately represented with a 3xl 
vector Ww, whereas in the Lagrangian formulation, it is redundantly represented with a 3x3 
matrix U i A factor of three in the relative efficiency of the two formulations is therefore 
to be expected. The redundancy in the angular velocity representation is manifested in the 
rotational kinetic energy expression. For the 3x3 representation, the rotational kinetic 


energy is as derived in equation (2.15): 

i 1 

| Oeer! i. 
K;=—3- Tr|( ) Uj aK ) Ui) 
es =| 

whereas for the 3x1 representation, the rotational kinetic energy is: 

a 
Using this new representation of the rotational kinetic energy, the complete generalized 
force expression 7, in the Lagrangian equation (2.22) changes to: 


x nee ow 


Fae [m,(g+e})— AGRI + SUNY eal “a 
\=i 4; naa 
OT 
Oc Ow 
r= JY if, — +n 4 (2.93) 
a4 aq 


where f , Tepresents the net force in Newton's equation, and n , Tepresents the net torque in 
Euler's equation. 

Therefore, contrary to what might have appeared earlier, there is no difference in the 
computational complexity of dynamics formulations derived from the Newton—Euler 
equations or the Lagrange equations. The recursive Newton—Euler equations are no more 
efficient than the recursive Lagrangian equations as long as the same representation of 


angular velocity is used. Moreover, the Newton—Euler equations would become as 
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inefficient as the original Uicker/Kahn equations if they were expressed in closed form. 
Consequently, the emphasis on computational complexity or on advanced control 
strategies synthesis should rest on the structure of the computation rather than on the 
derivation from Lagrange versus Newton—Euler equations. 
In addition, the designer will probably need both structures of the dynamic equations 


and more than one method of obtaining these equations throughout the different phases of 
the design process. He will need: 


1. A closed form expression of the manipulator dynamics in the early stages of the design 
process in order to be able to synthesize adequate control laws, 


2. More than one method of deriving the system dynamics equations in the computer 
simulation phase in order to be able to compare the solution obtained by different 
methods and place greater confidence on the simulation program, and 


3. A recursive form expression of the manipulator dynamics when implementing the 
chosen control law in real time. 
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Il. ADAPTIVE CONTROL FOR MECHANICAL MANIPULATORS 


A. INTRODUCTION 

The problem of controlling articulated mechanical systems such as manipulators using 
conventional control methods is very difficult when high speed and high accuracy 
operations are desired. The difficulty arises from the fact that such linkages are 
characterized by highly nonlinear and coupled ordinary differential equations. Closed form 
analytical solutions to these differential equations are not available. Instead, they must be 
solved by numerical integration on a digital computer, which, on the other hand, imposes a 
serious limitation on the number of calculations that can be performed in real time. 

The problem becomes even more difficult when the plant parameters are not precisely 
known and vary in time, as in most robotics applications. Furthermore, a joint angles to 
end point coordinates matrix transformation are usually required in such systems, which 
increases the burden on the computing machine. 

To maintain good performance over a wide range of motions and payloads, researchers 
have turned to adaptive control methods for their ability to adjust to parameters 
uncertainties and load disturbances. Unfortunately, most of these methodologies are not 
computationally efficient. As we have indicated in Chapter 1, two approaches to adaptive 
control theory can be found in the literature. 

In the Model Reference Adaptive Control scheme, the manipulator dynamic model is 
not directly used in the design so that the on line solution of differential equations is not 
required in the implementation. The manipulator is controlled by adjusting position and 
velocity feedback gains to follow a prescribed reference model. 

In the Learning Model Adaptive Control method, a model of the plant is obtained by on 


line parameter estimation techniques. This estimated model is then used in the feedback 
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control. For reasons of computation efficiency, most of the techniques in this category are 
based on linearized models of the manipulator which constrain the range of validity and of 
acceptable performances. Our main focus in this chapter will be to develop an algorithm for 
the Model Reference Adaptive Control of mechanical manipulators. 

In the next section, we will formulate the dynamic equations for mechanical 
manipulators in state space. This representation is more suitable for analyzing the 
performances of such methodologies. We will also give a detailed derivation of the state 
space equations of a two link arm model for illustration. 

Section three will review some leading adaptive control methods. These techniques will 
be simulated on the two link model using IBM/DSL [69]. We will compare their 
performances and point out some of their advantages as well as some of their limitations. 
The aim is to show where the need for better adaptive control strategies is felt. 

In section four, a novel adaptive control law which guarantees global stability and yields 
better performances is synthesized. A rapprochement between this method and the Model 
Reference Adaptive Control methodologies is also established. 

Section five summarizes the main results obtained in this study and outlines some areas 


for future research. 


B. MECHANICAL MANIPULATOR DYNAMICS IN TERMS OF STATE VARIABLES 
The standard inverse dynamics equations describing a mechanical manipulator are given 


in equation (2.24) of Chapter 2 and are reproduced here for convenience. 


r(t) = Afa(t)|a(t) + V[a(t).a(4)] + Gl a(x) (3.1) 
These equations can be rewritten as: 
a(t) = A4[q(s)] [r() — vfate).a()| - Gao] (3.2) 


In order to be able to gain better analytical insight to the control system design, it is 


convenient to rewrite equation (3.2) in terms of state variables. 
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Naturally, if one has no particular reason for other choices, the state variables and the 


input control vectors are, respectively, defined as: 


Nena) Di (3.3) 
ee |e | 
U(t) = rt) (3.4) 


where,q(t), q(t) and 7(t) are as defined earlier in Chapter 2. 


In addition, the vectors V{a(t),a(t) and Gla(t)| can be expressed as: 


V[a(t),a(t)] = Vil a(t), a(t)] a(t (3.5) 
Gla(t)] = Gi{a(t)]atw (3.6) 
Therefore, equation (3.2) can be rewritten as: 
X(t) = A(X (t),t)X,(t) + BX) (t,t), (t) (3.7) 
where 
: md _ q(t) 
X(t) = (X,(t)) = : ~ (3.8) 
0 Ge 
A(X (t),t) = pee nn senae (3.9) 
A-1(q(t)) Gi(q(t)):-A“'(q(t))Vi(q(t),q(t)) 
0 
BA p(t)st) iy eee | (3.10) 
A-1(q(t)) 





Here I, is the identity matrix of order n. 


The matrices V; a(t).a(t)| and G, -a(t)| are found as follows: 


Notice that the expression of V[a(t).a(t)| given in equation (2.22) of Chapter 2 can be 


rewritten as: 


V|a(t),a(t)] = V2] a(t)] V5} a(t) (3.11) 


where V3 Fa(t)| 1S given by: 
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and V2 fa(s)| is a matrix containing all the remaining terms of V[a(t),a()}. 


V3 fa(t)] can be expressed as: 


(t)a,(t) 
(t)a(t 
4 (t)q (t) 
Vala(t)} = f2P 8 | = valan face) 
q (t)a (t) 
q (t)q (t) 
with 
q (t)0.. 0 
0 4(t)O... 0 
0 0 q (t) 
v.[a(t)| = 
q (t) - 0 
0 0 q(t) 
Therefore, 


To obtain G; fa(t)], let 





i (| |G[a(t)] |] : 
q = 
| a(t) || 
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(3.13) 


(3.14) 


la , Gla(t)] — Gifa(t)} ee 
: 2S See ee | 
|G[q(t)] — Gi{q(t)]]| 


Hence, 


Gila(t)] = [Gi (a) (3.16) 


where |{.|| is the Euclidean norm of a vector and H . is the Householder transformation 


[70] defined as: 


Alu = J—2.u.u! (Sali 


C. SIMULATION STUDY OF SOME ADAPTIVE CONTROL METHODS 

In the remainder of this chapter, a two revolute joints arm model is considered. This 
model is shown in Figure 3.1. The equations of motions of this mechanical system are 
derived in detailed in the Appendix. Based on this model, a new adaptive algorithm, as 
well as some of the strategies presented in Chapter 1, are studied here in more detail. 
Considered are the inverse dynamics control technique, the variable structure control 
approach, the model following strategy and the perturbation control theory. The basic idea 
behind all these methodologies is to synthesize a control input 7 which will force the robot 
to follow the output of a reference model. The behavior we are concerned with here is the 
tracking in real time of desired trajectories. The reference model can be either a stable 
linear time invariant decoupled system as in the Adaptive Linear Model Following Control, 
or a combination of models such as in the Variable Structure Control, or a nonlinear 
nominal model of the plant as in the inverse dynamics control and the perturbation theory. 


1. Inverse Dynamics ‘Technique 


In this technique, the control input U_(t) is chosen as: 


U()=Alatt)| {4#(t)+K a(t) +K, et) }+V] a(t).a(¢)| +6/a(t)| (3.18) 
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Figure 3.1: Atwo link Mechanical Manipulator 
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where Ala(t)], Vfate).a(e)| and Glatt) are some estimates of Ala(t)], V{a(t).a(t)| 


and Gla(t)], respectively. 


This control law consist of two basic loops: 


1. A feedforward component: 
U g(t) = Ala(e)]aece) + W[ate),a(e)] + Glace]. 


This component is based on a dynamic model of the manipulator. It compensates for 
the interaction forces among various joints. 


2. A feedback component: 
(= Ala(t)]{ K é(t) + K c(t). 


This component is based on position and derivative feedback. It computes the necessary 
correction torques to compensate for any deviations from the desired trajectory. 


Among the attractive features of this method is the fact that, in principle, it turns a 
nonlinear, coupled mechanical system into a linear, decoupled, and stable system. This can 
be seen by substituting the above torques expression of equation (3.18) into equation (3.1) 


to obtain: 
AG+V+G=Alq+Ke+Ke}+V+6 (3.19) 
where the arguments have been omitted for convenience. 


If A= A, V = Vand G = G, equation (3.19) reduces to: 


Ala(t)| {8(t) +K ét) + K 5e(t)| = 0 (3.20) 


Since Ala(s)| is always nonsingular, K_ and ie can be appropriately chosen so that the 


p 
position error vector e(t) approaches zero asymptotically. This control strategy is 


simulated on the two arm model presented earlier. The desired trajectories are chosen as: 
q(t) = 270t2 — 180t3 (3-215) 


qa(t) = 45 + 270t? — 180t3 (3.22) 
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These trajectories are shown in Figures 3.2 and 3.3. The gain matrices K.. and KY are 


chosen as: 
100 OQ 
K = 
p 
0 100 
20 O 
KY = (3223) 
QO 20 


In this case, where we assume complete and exact knowledge of the manipulator dynamics, 
we obtain perfect tracking of the desired trajectories. This can be seen in Figures 3.4 and 
3.5, where the actual trajectories (qy and q>) and the desired trajectories (a¢ and 45) are 
virtually indistinguishable with the tracking errors (¢, and @,) shown in Figure 3.6. Also 
the magnitudes of the torques applied at the joint actuators are bounded with reasonable 
values as shown in Figure 3.7. 

The main drawback of this method is inherent in its assumption that one can 


accurately compute the counterparts of Alatt)], V Jatt), a(t) | and Gla(t)}. Unfortunately, 
this is not always the case in robotics applications. When Ala(t)}, V{a(t).a(t)| and 


Gla(t)| are not equal to Ala(t)]. V|a(t).a(t)| and Gla(t)). the quality of the tracking 
degrades and the system may even become unstable. Simulation results with 10% error in 
the load are reported in Figures 3.8 through 3.11. In Figures 3.8 and 3.9, we can see that 
the actual trajectories (qd) and qo) diverge from the desired trajectories (a and 45). The 
position error is in the order of 6° in the first link and of 13° in the second link (Figure 
3.10). The applied torques (Figure 3.11) are of reasonable values. 

One may try to overcome this limitation by combining the above scheme with an on 
line identification algorithm to compute Alatv)], V[a(t),a(1)|, and Gfa(e)| [71]. This, 
however, is computationally demanding since the computed torque, in itself, requires a 


number O(n#) of calculations, n being the number of links in the manipulator. 
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Figure 3.2: The first link test trajectory 
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Figure 3.3: Ihe second link test trajectory 
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Figure 3.4: The first link desired (q(t) ) and actual (q, (t)) 
trajectories under the Inverse Dynamics Controller 
(Perfect Modeling) 
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Figure 3.5: The second link desired (qd(t)) and actual (q,(t)) 


trajectories under the Inverse Dynamics Controller 
(Perfect Modeling) 
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Figure 3.6: The joint one (ej; (te) jeand che joint two (el Gaye 
tracking errors under the Inverse Dynamics 
Controller (Perfect Modeling) 
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Figure 3.7: The total torques applied to joint one (6, (t)) and 
to joint two (G,(t)) under the Inverse Dynamics 
Controller (Perfect Modeling) 
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Figure 3.8: The first link desired (q4(t) ) and actual (q, (t)) 
trajectories under the Inverse Dynamics Controller 
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Figure 3.9: The second link desired (q4(t)) and actual (q,(t)) 
trajectories under the Inverse Dynamics Controller 
(Approximate Modeling) 
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Figure 3.10: The joint one (e, (t)) and the joint two (e,(t)) 
tracking errors under the Inverse Dynamics 
Controller (Approximate Modeling) 


60 





Torques (N/m) 





0 0.1 O52 0.3 0.4 Oro 0.6 OF. 


~] 


0.8 0.9 1 


Time (sec.) 
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to joint two (@,(t)) under the Inverse Dynamics 
Controller (Approximate Modeling) 
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2. Variable Structure System 
A different approach which yields a simple and robust control can be obtained by 
using a variable structure strategy. The theory of variable structure control has mostly 
been developed in the Soviet Union over the last 25 years and has found applications in 
many industrial processes [72]. The fundamental idea behind the theory of variable 
structure is to allow the controller to switch between different strategies, according to 
appropriate functions of the trajectory error. 


A variable structure contro! is of the form: 


uh AX (t).t), 5 (e,) > 0 
(ia) = (3.24) 
un AXp(t),t), Sle) <0 


{Ol 2 = 15 2, Tia WHene Uj is the in component of the input vector U, and, 


5 fe.) = Cor e pt. > 0, is the ifn component of the switching hypersurfaces. The design 


problem consists of choosing the functions u* and the switching hyperplane matrix 


p2’ UDP 
C = diag(c ) such that the sliding mode occurs on the switching hyperplanes, the tracking 
error has an acceptable transient response and it goes to zero asymptotically as t > ». This 
methodology is simulated on the two link arm model. The desired trajectories are the same 
as before. The switching planes are chosen as: 

5, =0.5e,+ €, 
5 9 = 0-4 + by 
In addition, to ensure the existence of the sliding modes, the control law is chosen as: 


(X 
UX 


(t),t) =— jalle |+a2/é ,|+a3|e,|+a4]€,| +25] q4| +o Jsgn(S 

In the absence of a procedural method to selecting the parameters al, a possible choice 
which will facilitate the calculations is: 

a= 0, a? = Us Be 0, at = OF sie Oand o = 


a=0,0@=0 ,a=0 0 —0 edo 
2 2 2 2 2 2 
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The results of this computer simulation are reported in Figures 3.12 through 3.15. In 
Figure 3.12, the first link actual trajectory (q,) tracks the desired trajectory (q°) with 
approximately 7° error because of poor choice of the parameters at. The actual trajectory of 
the second link, however, shows better tracking as seen in Figure 3.13. Figure 3.14 shows 
the time evolution of the’errors e, and e, in both joints. As expected, Figure 3.15 shows 
considerable chattering in the input signals. These simulation results highlight the fact that 
chattering in the input signals, absence of a procedural method to choosing the control 
parameters al, and the difficulty of guaranteeing the existence of the sliding modes are the 
main reasons that limit the applicability of this scheme to multivariable control systems. 
3. Adaptive Linear Model Following Control 
This scheme is depicted in Figure 3.16. The reference model is chosen to be a stable, 
linear, time invariant and decoupled system as: 
X(t) = A,X (t) + BU (t) (Bea) 
where the torques UL (t) are selected so that the output X(t) of the model follows 


precisely the desired trajectories. described by the user. inn and ee are of the form: 


0 ie 
Ve a es (3.20) 
io —e 
- diag (a. 9;) - diag(a, ,) 
0 
B= er Ber 
Ty 
with 
amo? 98> ami? ® 


ee — 1 2, Le mManipularon 


For the purpose of simulation. De 1.5 and an 14 


input Uy, is chosen as: 


X_t) = Ov. = X., K 2 
U,(v.X,.t) = @(v.X,t)X, KX, + Wv.X)t)U, + KUL, (3.28) 
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Controller (Perfect Modeling) 


64 


2.60 


2.3 
zi q°(t) 
2 y 
\y 
1.8 
Z 4.65 
a, 
e 
& 
= 1.3 
g q (+) 
= 2 
be Hh 
0.8 
0.60 
0.0 0.1 or¢ Us) 0.4 0.5 0.6 C7 0.8 OB 10 


Time (sec.) 


Figure 3.13: The second link desired (q(t) ) and actual (q,(t)) 
trajectories under the Variable Structure 
Controller (Perfect Modeling) 
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Controller (Perfect Modeling) 
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to joint two (@,(t)) under the Variable Structure 
Controller (Perfect Modeling) 
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where K_ and K , are feedback constant gain matrices designed for specific nominal values 


Pp 
of the plant to satisfy the perfect model following conditions given by: 
K_ =-— At ~ 
p =~ At(alt)) (Ag, — Ap) (3.29) 
ee (40) ae (3.30) 


with A*(q(t)) being the pseudoinverse of A(q(t)). 
The quantities @ and W are generated by the adaptation mechanism to guarantee the 


stability of the overall system. Possible choices are: 








b= ¢ - (sgn(X,))" (3.31) 
y= 2 ; (sgn(U_,))? (3.32) 
with 
| Amax(RRT)| ; 
——— (Ga) 
Amin(A™! (q(t))) 
[ Amax(ssv)] 
> (3.34) 
Amin(A-!(q(t))) 
where 
R= A‘ q(t))A*(q(t) (AQ, — Ap) + AX(a(t)) Ky (3.35) 
S = AV(q(t))A*(q(t))B. — ANa(t))K (3.36) 


Simulation results of this technique with Ky and K,, obtained from equations (3.29) and 


es0) at t = 0 as: 


Sera aC BELT NL 5 
K = K = 
p ~ K, (9) 
30.4 4.91 1ef2 833 
Zt | 00m 
Kei (Ole 
.687 .333 





are reported in Figures 3.17 through 3.20. Since the matching matrices K, and K, are not 


adjusted in time, we can see that the actual trajectories (q and q.,) follow the desired 
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Figure 3.17: The first eiedesiured (q4(t)) and actual (q, (t)) 
trajectories under the Adaptive Model Following 
Controller (Matching Matrices not adjusted) 
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Figure 3.18: The second link desired (q¢(t)) and actual (Gs(t) ) 


trajectories under the Adaptive Model Following 
Controller (Matching Matrices not adjusted) 


0:20 


Oe 





OF 





© 

SS 

On 
rr 


Position error (rad.) 
| 
io) l S 
= = O 
Cr — cn 


{ 
na 
i) 


0 Oe: Gee 0.3 0.4 0.5 0.6 0.7 0.8 vee 1 


Time (sec.) 


Figure 3.19: The Joint one (e, (t)) and the joint two (e,(t)) 
tracking errors under the Adaptive Model Following 
Controller (Matching Matrices not adjusted) 
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Figure 3.20: The total torques applied to joint one (%@(t)) and 


to joint two (@a(t)) under the Adaptive Model 
Following Controller (Matching Marices not adjusted) 
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trajectories (q° and 45) with an error of 4° in the first link (Figure 3.17) and of 7° in the 
second link (Figure 3.18). The joints errors (€) and €5) are shown in Figure 3.19. The 
control signals (Figure 3.20) are chattering due to the high frequency component. 

Using this type of adaptation, on line numerical integration of the dynamics 
equations of motion is avoided. However, the signals that the actuators are required to 
generate (Figure 3.20) are about 10 times larger than in the computed torque (Figure 3.11). 
This is a serious threat to the plant hardware since the forcing signals are discontinuous. 

To be able to reduce the parameters ¢ and €, and hence, the actuation signals, one 
should calculate K,, and i that will satisfy the perfect model following conditions of 
equations (3.29) and (3.30) at each instant of time. Simulation results obtained using this 
fact are given in Figures 3.21 through 3.24. In this case, the trajectory of the first link 
(Figure 3.21) as well as the trajectory of the second link (Figure 3.22) show very close 
tracking. the position errors in both the first and the second links are reduced to zero 
(Figure 3.23). The actuation signals (Figure 3.24) are still large. The main disadvantage of 
this choice is, however, the added computational complexity. 

4. Adaptive Perturbation Control 

A block diagram of this scheme is shown in Figure 3.25. This methodology uses an 
available nominal model of the system and the recursive Newton—Euler equations of 
motion to compute nominal control inputs for a given trajectory. These nominal torques 
compensate for all the interaction forces among various joints along the nominal trajectory. 

To compensate for small deviations from the nominal trajectory, a feedback adaptive 
component is introduced. This adaptive control is based on linearizing the manipulator 
dynamics equations in the vicinity of known nominal trajectory set points to obtain the 
associated perturbed state equation: 


é = Ae + Bdr (3.30) 
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Figure 3.22: The second link desired (qd (t)) and actual (q y(t 
trajectories under the Adaptive Model Following 


Controller (Matching Matrices adjusted) 


76 


~0.002 os _ e, (t) 


a) .004 - 





a. 0 1 


Position erro (rad ) 
= = 
2 S 
© © 
Co oO 
| a | 


—@-012 
~0.0145 


=0,016 : 
0.1 0.2 OES 0.4 0.5 0.6 ete 0.8 0-9 1 


Time (sec.) 
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tracking errors under the Adaptive Model Following 
Controller (Matching Matrices adjusted) 


77 


% (t) 





-50+ 


-100 ; | | : 7 : a | G, (t) 


. % ° * 
‘ 3 , ~ 

be] $ : “t : By : , 

—_— . a = = > = 
= : S > : 
: ; ‘ 5 : = 3 M j 

s < Pa : : + : : : a ? 

: es 3 ; : : 3 : : 4 2 : : 

t sO 2 Pike : 

> : ° : = : : 

: : 


fie 88) poe aa 
ae eee 


Torques (N/m) 


=2001- 


-—290 : 
0 0.1 O-2 0.3 0.4 0.5 0.6 One 0.8 Oye i 


Time (sec.) 


Figure 3.24: The total torques applied to joint one ( @(t)) and 
to joint two (%,(t)) under the Adaptive ‘Model 
Following Controller (Matching Marices adjusted) 


ROBOT LINK PARAMETERS DISTURBANCES 


NEWTON-EULER eosorT 


pe) aie MANIPULATOR ENVIRONMENT 





















RECURSIVE 
NE-STEP 
i Orrin Bee eaten ais, | SOSUERE 
CONTRO IDENTIFICATION , ¢ 
LLER ie 


SCHEME 


x(k) 


Fk}, Gtk 


afk) 


Figure 3.25: Adaptive Perturbation Control 
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where e and é are as defined earlier and dr = U — U,, U,, being the nominal torque inputs 
as obtained from certain available nominal model of the manipulator. The system 
parameters A and B depend on the instantaneous manipulator position and velocity along 
the nominal trajectory. A recursive least squares parameters identification technique is 
used to estimate the unknown elements in A and B. The obtained parameters are then used 
to formulate a one step optimal controller that will generate the torques dr to compensate 
for the perturbations. When only the feedforward torques are implemented, simulation 
results show that 10% error in the load produces tracking errors in both the first (Figure 
3.26) and the second (Figure 3.27) links. As seen in Figure 3.28, these tracking errors are in 
the order of 6° and of 9°, respectively. The input torques (Figure 3.29) stay within 
reasonable limits. Figures 3.30 through 3.33 give the results of the same simulations as 
above when both the feedforward and the correcting torques are used. While an improved 
tracking is experienced in both the first (Figure 3.30) and the second (Figure 3.31) links, 
the joint errors (Figure 3.32) are still of the order of 5° and 3°, respectively. The input 
control signals ( shown in Figure 3.33) stay within the same range of values as before. 
These results are, however, expected since this strategy assumes slow variations and small 
deviations about the desired trajectory. 

It is evident from the above discussion that in order to extend the capabilities of 
manipulators and improve their overall dynamic performances, there is a need to 
investigate and develop better adaptive control solutions to current control problems. 

The aim of the next section is to present a novel adaptive control law for mechanical 
manipulators that enjoys global stability and overcomes some of the limitations of the 
previously studied methodologies. This strategy combines properties from both the the Self 
Tuning Regulator in [51] and the Model Reference Adaptive Control in [63] and offers itself 
to microcomputer implementation. This technique serves also to extend the Model 


Reference Adaptive Control method into using a nonlinear reference model. 
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Figure 3.26: The first link desired (q4¢(t)) and actual (q, (t)) 
trajectories under the Adaptive Perturbation 


Controller (No Adaptation) 
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Figure 3.27: The second link desired (q2(t)) and actual (q,(t)) 
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Controller (No Adaptation) 


82 


Position error (rad.) 


0,120 


e, (4) 


0).060- 


0-04 0 
0 —_ ~ oo 


\ G3 
f aa 


~ 0.000 ~~ 
~ 0.120- oe 





er ae! 
~0.160- . 
-0.200 ae es 
o.0 On 0.2 0.3 0.4 0.5 0.56 (.7 0.68 0.3 


Time (sec.) 


Figure 3.28: The joint one (e,(€)) andthe joint two ree (t))) 
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Figure 3.31: The second link desired (qd(t)) and actual (q,(t)) 
trajectories under the Adaptive Perturbation 
Controller (With Adaptation) 
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and to joint two ( @,(t)) under the Adaptive 
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D. ADAPTIVE NONLINEAR MODEL FOLLOWING CONTROL 

Figure 3.34 illustrates the structure of the proposed adaptive control system. The task of 
the controller is to generate the control signals in order to follow a desired trajectory 
despite the changes in the manipulator's parameters and the errors in the dynamic model. 
The desired trajectory is specified in terms of joint angles q4(t) and their derivatives q4(t) 
and q¢(t). The total torques 7 are obtained through a nominal and a correction loops. 

The nominal loop is justified by the fact that, in practice, a nominal model of the 
manipulator is always available to the designer. The nominal parameters are used to 
construct a recursive inverse dynamics that generates nominal torques 7 The inputs qi 
qn and q,, to the recursion are obtained by adding filtered error signals z(t), z(t), and 2(t) 
to the desired signals q4, q4, and qd. The signals z(t) are chosen such that: 

Z(s) = F(s) Es) (3.38) 
where F{s) is the transfer function of a linear filter to be determined and Z(s) and F{s) are 
Laplace transform of 2(t) and e(t) respectively. The recursive form is chosen to ease the 
computation. The inverse dynamics form is motivated by the fact that, in the case where 
the mechanical manipulator model is known precisely, an exact trajectory following is 
obtained. The adjusting signals z(t) are selected to reach the ideal closed loop dynamics 
given by the error equation: 

€(t) + K e(t) = K e(t) a0 (3.39) 

Since some manipulator parameters such as load and inertia vary in time and some 
others such as friction in the gears and motors backlash are very difficult to determine, 
additional correction feedback torques d7 are necessary to account for any deviations from 
the desired trajectory due to these effects. These correcting torques are generated to 
guarantee global stability: 


lime(t) =0 (3.40) 


to 
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In total, the input torques 7 are the sum of i and dr. 
oe il (3.41) 
where 7,, are the outputs of the recursive algorithm given by: 
ra(t) = Alan(t)]aq(t) + Vian(t).4,(t)] + 6] a,(0)] (3.42) 
and dr are to be determined. From the equations of motion of the manipulator, the total 


torques 7 can also be expressed in terms of the joint angles q(t) as: 
r(t) = Ala(t)]a(t) + Vfatt),a(t)] + Glatt) (3.43) 
Subtracting equations (3.43) from (3.42) and substituting dz by its expression in equation 
fea) yields: 
Ala(t)| (a(t) — a(t)] = W[a(t).a,(t),4(0).4,,(0)] + ar (3.44) 
or, since A fa(0)] is nonsingular, 
a,-4=- AW + dr (3.45) 


where the arguments have been omitted for convenience and where, 


W=AV |a(t).a,(t),4(t),4g(t)] +AG|a(t).a,(t)] +4] a(t).9, (+) ]a, 


(3.46) 
with 
AV = Via,(t)-4,(t)] — Va(t).a(+)| (3.47) 
AG = Gla,(t)| , Gla(t)| (3.48) 
Ne Ala,(')| 2 Ala(t)| (3.49) 
lim Wa(t).ap(),4(t).4,(t)] = 0 (3.50) 
as q(t) + q,(t) and 4(t) > 4,(t). 
On the other hand, 
A, 4 = 44 + L(92F(s)A(s)) — a (3.51) 


wl 


That is, 

q,7 q=é@+ L1'(s2F{s) Ks)) (Seo) 
where L1(.) is the inverse Laplace transform of the given function. Substituting the 
expression of (q, — q) from equation (3.52) into equation (3.45) we obtain: 

+ L-\(s2F{s)(s)) = — Av! Ww + dr (3.53) 
Equation (3.53) shows that the adjusting forward signals are crucial to the stability of the 
system. When these signals are not used, such as in [51], the error equation is unstable. 
Any stable filter F{s) of the form: 
an-28% 2 + ap-gs8 3 +... + ag 
fs) = (3.54) 
DpaS® + Dp-18sM!+ ...+ bo 
will yield the desired error equation in (3.39). A more interesting choice, however, is: 


al 
Fs) = 7 (K,s + K,) (3.55) 


where Ky and KO are velocity and position feedback matrices, respectively. The motive 
behind choosing F{s) as in equation (3.55) lies in the fact that it relaxes the computation 
considerably. This can be seen by evaluating z(t), z(t), and Z(t) corresponding to this 
choice: 

2(t) = L-\(s?F\s) Ks) 

a(t) = K é(t) + K ett) (3.56) 
which is actually no more than velocity and position measurements feedback. The 
quantities z(t) and z(t) can then be obtained from the above expression of Z(t) by a simple 
and a double integration, respectively. With F{s) selected as in equation (3.55), the error 
equation in (3.53) becomes: 

Bae IS Gas Ke = — A|W - dr (Sioa 


Equation (3.57a) is an equivalent error model representation of the proposed adaptive 


contro] law. It can be partitioned into a linear time invariant system connected with a 


OZ 


nonlinear time varying block in the feedback as shown in Figure 3.35. It should be clear 
that K, and K,, are chosen such that the forward transmission function is stable. 
Notice that, if a filter of the type given in equation (3.54) is used instead, the term is 


decomposed as: 


F(s) = 1— F(s) 
Hence, equation (3.53) becomes: 
é+Kyé+ Ke =- AW f dr (3.57b) 
with 
Wi=W+ L-1( F (s) Xs) 


which is a more general form of equation (3.57a). 


Jt remains now to determine the control inputs dz based on the knowledge of some 


| W/a(t).a,(t),4(¢),4,(¢)] | 


such that || e(t) || < ¢, for t +o and for any initial conditions. Here ¢ is a small number. 


upper bounds of: 





Let 


mt) = 2(t) = L\(s?F\s) Ks) 
Thi) = K, €(t) + K elt) (3.58) 
The quantity mt) is given by: 
oe K, [an + AT Ww + dr (3.59) 
with a= Ky'K, = diag(a.), a> 0 {OTe ! Aaueince 


K, = diag(k, ). ky; >0 and K, = diag(k,), k,;> 0. 





Define dz as: | 
d7(t) = ({t) a (3.60) 
mt) 
with 
(t) > Amax(A)|| WTA] (3.61) 
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FACT: 
Equations (3.60) and (3.61) imply: 
lim f(t) = 


00 





Consequently, 
lim e(t) = 0 
to 
lim é(t) = 0 
t- 0 
lim (q,—a¢) =0 


ta 


PROOF: 


The above claim can be proven by choosing a Lyapunov function V(7) as follows: 


V(n) = ~y— 1"(t) at) 


Then 
V(n) = at(t) nt) 
VG) ae nak, n+ WIAIK 9+ dTTAK 1) 
Notice that since a = diag(a,),@,>0 and K, =diag(k,.),k.> 0, then 
= p= diag(5.,), B. Sik 
Now replace d7(t) by their expressions in (3.60) to obtain: 
V(9) = — n° Bn— [WTA- TG aia) oa =—_ 


“| 2 | 
If we select f(t) so that: 


Amin(A!)é> || WTA7}|| 


then 

V(n) $— nt Bn<s —B., a(t) nt) 
That is, 

V(n) < — 26, V(n) 
with 


(3.62) 


(3.63) 
(3.64) 


(3.65) 


(3.66) 


(3.67) 
(3.68) 


(3.69) 


(3.70) 


(3.71) 


(3.72) 


a = min(f'), ior? — eee 
by which (3.62), (3.63), (3.64) and (3.65) are satisfied. 
The proof for the case where the filter in (3.54) is used, follows along the same lines. 
QED 


The above control law is simulated on the two link arm model. The following values of @, 


Ky and KY are used: 


lo 0 
pS 
0 10 
di) 
K = 
p 
0 4 
4 0 
Ki 2 
Vv 
0 4 


When 10% error in the load is assumed, the tracking quality, when no feedback corrections 
are applied, is poor in both the first (Figure 3.36) and the second (Figure 3.37) links. The 
joint errors are of the order of 6° and 17°, respectively as shown in Figure 3.38. The toque 
signals (Figure 3.39) are similar to the ones obtained from the inverse dynamics law. There 
is no noticeable improvement (or little) in the tracking quality of both the first (Figure 
3.40) and the second (Figure 3.41) links, when the adjusting signals z(t), z(t), and Z(t) 
alone are used. This can be seen from the plots of the time evolution of the tracking errors 
in Figure 3.42, and of the input torques in Figure 3.43. However, the quality of the tracking 
is improved drastically in both the first (Figure 3.44) and the second (Figure 3.45) links, 
when both the adjusting signals and the correction torques are implemented. Figure 3.46 
shows that the tracking errors in both links are practically reduced to zero. This is about 8° 
better than [51] and 10° better than [63]. As expected, figure 3.47 shows a moderate 
chattering, within a very acceptable range of values, in the control signals. Because 


integrators are used to generate z(t) and z(t), it is of interest to check that the presence of 
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Figure 3.36: The first link desired (q(t) ) and actual (q, (t)) 
trajectories under the Nonlinear Adaptive Model 
Following Controller assuming Parametric 

Uncertainties only (No Feedback) 
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Figure 3.37: The second link desired (q2(t)) and actual” (quam 
trajectories under the Nonlinear Adaptive Model 
Following Controller assuming Parametric 
Uncertainties only (No Feedback) 
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Figure 3.43: The total torques applied to joint one (6,(t)) and 
to joint two (@,(t)) under the Adaptive Model 


Following Controller assuming Parametric 
Uncertainties only (Using Adjusting Signals alone) 
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Figure 3.44: The first link desired (q4(t) ) and actual (q, (t)) 
trajectories under the Nonlinear Adaptive Model 
Following Controller assuming Parametric Uncertainties 
only (With Adjusting Signals and Correcting Torques) 
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offset measurements in such signals does not affect the tracking quality of the overall 
system. Simulations results with initial conditions of €) = €y = 115” are given in Figures 
3.48 through 3.51. There is practically no degradation in the tracking quality of either the 
first (Figure 3.48) or the second link (Figure 3.49). The tracking errors (Figure 3.50) and 
the input torques (Figure 3.51) are as before. To show the robustness of this methodology 
to parameter disturbances, 50% error in the load is assumed and a term of the form F = 
Csgn(q ) — Vd, is added to the plant as unmodelled friction, where C and V are Coulomb 
friction and viscous friction constants, respectively. The simulation results from this case 


with C = V = 4 are reported in Figures 3.52 through 3.63. The actual trajectories (q, and 


] 
q>) diverge considerably from the desired trajectories (a and 45) when no feedback is used 
as seen in Figures 3.52 and 3.53, respectively. The tracking errors are in the order of 32° in 
the first link and of 114° in the second link as shown in Figure 3.54. The required input 
torques are reported in Figure 3.55. A considerable improvement in the tracking quality of 
both links is achieved even when only the adjusting signals alone are used as can be seen in 
Figures 3.56 and 3.57, respectively. However, the joint errors are still of the order of 12° in 
the first link and of 23° in the second link as seen from Figure 3.58. The control signals are 
reported in Figure 3.59. When both the adjusting signals and the feedback correcting 
torques are implemented, the tracking quality is close to perfect as can be seen in Figure 
3.60, for the first link and in Figure 3.61, for the second link. The errors in both links 
(Figure 3.62) are drastically reduced to approximately 0.3° and 0.1°, respectively; while the 
input torques (Figure 3.63) remain at very acceptable range of magnitudes with mild 
chattering. When these same conditions are simulated with the Adaptive Perturbation 
Control Law of [51], the quality of the tracking is poor for both the first (Figure 3.64) and 
the second (Figure 3.65) links. Figure 3.66 shows the time variations of such errors. These 
errors are of an order of magnitude of 15° in the first link and of 12° in the second link. 


Respectively. this is about 50 and 120 times less accurate than the proposed approach (see 
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Figure 3450: The joint one (e, (t)) and the joint two (e, (t)) 
tracking errors under the Nonlinear Adaptive Model 
Following Controller assuming Parametric 
Uncertainties only (With 115° offset) 
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Figure 3.51: The total torques applied to joint one (6,(t)) ana 
to joint two (6,(t)) under the Adaptive Model 
Following Controller assuming Parametric 
Uncertainties only (With 115° offset) 
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Figure 3.52: The first link desired (qt (t)) andwactual (q (em 
trajectories under the Nonlinear Adaptive Model 
Following Controller assuming Parametric and 
Unstructured Disturbances (No Feedback) 
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Figure 3.53: The second link desired (q4(t)) and actual (q5(t)) 


trajectories under the Nonlinear Adaptive Model 
Following Controller assuming Parametric and 
Unstructured Disturbances (No Feedback) 
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Figure 3.55: The total torques applied to joint one (6,(t)) and 
to joint two ( @~.(t)) under the Adaptive Model 
Following Controller assuming Parametric and 
Unstructured Disturbances (No Feedback) 
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Figure 3.56: The first link desired (qt (t)) and actual (q, (t)) 
trajectories under the Nonlinear Adaptive Model 
Following Controller assuming Parametric and 
Unstructured Disturbances (With dG= 0) 
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Figure 3.57: The second link desired (q4(t) ) ondmactual (q, (ty) 


trajectories under the Nonlinear Adaptive Model 
Following Controller assuming Parametric and 
Unstructured Disturbances (With d@ = 0) 
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Figure 3.59: The total torques applied to joint one (6,(t)) and 


to joint two ( @3(t)) under the Adaptive Model 
Following Controller assuming Parametric and 
Unstructured Disturbances (With dé = 0) 
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Figure 3.60: The first link desired (q4(t)) and actual (q,(t)) 


trajectories under the Nonlinear Adaptive Model 
Following Controller assuming Parametric and 
Unstructured Disturbances (Complete Scheme) 
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Figure 3.61: The second link desired (qt (t) ) and actual (q,(t)) 


trajectories under the Nonlinear Adaptive Model 
Following Controller assuming Parametric and 
Unstructured Disturbances (Complete Scheme) 
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Figure 3.62: The joint one (e, (t)) and the joint two (e,(t)) 


tracking errors under the Nonlinear Adaptive Model 
Following Controller assuming Parametric and 
Unstructured Disturbances (Complete Scheme) 
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Figure 3.63: The total torques applied to joint one (6,(t)) anda 
to joint two (62(t)) under the Adaptive Model 
Following Controller assuming Parametric and 
Unstructured Disturbances (Complete Scheme) 
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Figure 3.64: The first link desired (q(t) ) and actual (q,(t)) 
trajectories under the Adaptive Perturbation 
Controller (With Unmodeled Disturbances) 
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Figure 3.66: The joint one (e,(t)) and the joint two (e,(t)) 
tracking errors under the Adaptive Pertubation 
Controller (With Unmodeled Disturbances) 
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Figure 3.62). Also, as seen in Figure 3.67, the input torques are about 10 times larger than 
the input torques required by our control law (see Figure 3.63). Similarly, when the same 
conditions as above are simulated with the Linear Model Following Control Law of [63], 
The actual trajectories (qj and q,) diverge from the desired trajectories (a and aS) as 
seen in Figures 3.68 and 3.69. Figure 3.70 shows that the tracking errors reach, 
approximately, 29° in the first link and 35° in the second link. Here, again, the superiority 
of the proposed control methodology is evident. 

A deeper insight into this adaptive control method may be gained by considering its 
relation to the general structure of Model Reference Adaptive Systems and to the Adaptive 
Model Following Controller in particular. 

Referring to Figure 3.34, the same system can be represented in a slightly different, but 
equivalent, arrangement as shown in Figure 3.71. This particular representation highlights 
more clearly the parallel structure of this control law. 

Now consider Figure 3.72 which gives a block diagram representation of the standard 
Model Following Control law [73]. A fundamental difference between Figure 3.71 and 3.72 
is the fact that the flow of signals through the reference model in Figure 3.71 is reversed. 
This results from our formulation of the general manipulator control problem in which we 
assume that in practice a desired trajectory is specified by the user and not the input 
torques to the manipulator. 

The reference model in the standard Adaptive Model Following Control is chosen to be 
asymptotically stable. That is, ee is a Hurwitz matrix. The Newton—Euler recursion we 
are uSing is also a stable algorithm, in the sense that for every desired trajectory point 
(q4,q¢) where 1q9| < o and | q¢ | < o, it yields a vector torque 74 where 7, < 0. 

The feedforward matrix gain K the plant feedback matrix gain Ky and the model 
feedback matrix gain Ne in Figure 3.72 are chosen such that, for null initial conditions and 


specific plant parameter values, perfect model following exists. That is: 
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Figure 3.67: The total torques applied to joint one (6,(t)) 
and to joint two ( @3(t)) under the Adaptive 
Perturbation Controller (With Unmodeled Disturbances) 
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Figure 3.69: The second link desired (q4(t) ) and actual (q,(t)) 
trajectories under the Adaptive Model Following 
Controller (With Unmodeled Disturbances) 
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Figure 3.72: The standard Adaptive Linear Model Following Control 


lim A(t) = Apa(t) (73) 


t- 0c 


lim Bt) = B,,(t) (3.74) 
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lime(t) = 0 (3:75) 
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lim et) = 0 (3.76) 
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In the proposed adaptive control methodology of Figure 3.71 , the reference model is an 
available nominal model of the plant itself used as an inverse dynamics. That is, in at least 
a limited range of applications for which it has been calculated, this model adequately 
describes the plant under consideration. When this is the case, perfect model following can 
be achieved without the need for any adjustment, by choosing = (Ih i = 0 and K = 
In. This particular choice of Ky See and kK, means that in the case where the values of 
the plant parameters are precisely known and do not vary during operation, the adaptation 
mechanism is not needed just as in the standard Adaptive Model Following Control. In 
fact, the control law reduces to an inverse dynamics control. Simulation results of this 
situation are shown in Figures 3.73 through 3.76. Figures 3.73 and 3.74 show that, in the 
ideal case where all the parameters are known, the actual trajectories (q, and qo) follow 
very closely the desired trajectories (a4 and 4S), with no need for adaptation. The time 
evolution of the joint errors (e, and @o) are converging to zero as we can see from Figure 
3.75. Figure 3.76 shows that the corresponding input torques are within an acceptable 
range of values and of reasonable chattering. 

As for the standard Adaptive Model Following Control, when the perfect model 
following exists, the role of the adaptation is to assure the convergence to this solution 
when the plant parameters are uncertain or vary during operation. This is shown to be the 
case in equations (3.64) through (3.70). This adaptation law can be classified as a signal 


synthesis adaptation since the feedback signals z(t), z(t) and z(t) are used to either reshape 
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Figure 3.76: The total torques applied to joint one (6,(t)) ana 
to joint two (@3(t)) under the Adaptive Model 
Following Controller (Perfect Modeling) 
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the forward torques T,, or to generate additional torques dz which are both acting as input 
signals to the plant when the values of its parameters differ from the nominal ones. 

The fact that the flow of the signals through the’ reference model in Figure 3.71 is 
reversed, does not, theoretically, affect the equations governing the overall system. This 
can be seen from the equivalent error model representation of equation (3.57) and Figure 
3.35 which is the same structure as for the standard Adaptive Model Following Control. 

Finally note that this method is very insensitive to the parameters ét). Simulation 


results when 


20 «60 
&t) = 
Ga 16 
and when 
120 0 
Ch 
0 118 


are reported in Figures 3.77 through 3.80. Figures 3.77 and 3.78 are practically the same as 
Figures 3.60 and 3.61 obtained earlier with a different gain matrix &t). The robustness 
property is inherent to the fact that the proposed control law is a switching law as can be 
seen from Equation (3.60). Figures 3.79 and 3.80 show that, when the gains matrix is 
excessively large (8 times the nominal values), the quality of the tracking is degraded. 
However, the joint errors experienced in this case may still be more tolerable than the the 
joints errors experienced with the control law of [51] or the control law of [63]. 

It is also very important to point out that the proposed adaptive control law is 
numerically more efficient than [51] since it does not explicitly estimate the feedback 
model. and more efficient than [63] because it does not require the use of model matching 
matrices. This should be very attractive feature since adaptive control techniques suffer 


from computational complexity in general. 
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trajectories under the Nonlinear Adaptive Model 
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Figure 3.78: The second link desired (qt (t)) and actual (q.(t)) 


trajectories under the Nonlinear Adaptive Model 
Following Controller assuming Parametric and 
Unstructured Disturbances (With Large Gains) 
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E. CONCLUSIONS AND FUTURE RESEARCH 

A new adaptive control law for mechanical manipulators that maintains uniformly good 
performance over a wide range of motions and payloads has been developed. This control 
strategy has been shown to combine properties from both the Model Reference Adaptive 
Control and the Self Tuning Regulator theory. It has also been shown that this method 
serves to extend the Adaptive Model Following Control Approach into using a nonlinear 
model as a reference. 

The design procedure is simple and systematic resulting in an overall system which is 
globally stable and offers itself to microprocessor implementation. We have also shown that 
this control law is robust with respect to variations of the plant parameters. The 
effectiveness of the approach has been demonstrated on several computer simulations which 
compare its performances against some of the commonly known adaptive control 
techniques. In all cases, the proposed adaptive control strategy has performed better. 

This adaptive control] scheme has reduced the chattering in the input torques to a 
"reasonable" value compared to [59] and [63]. We are currently investigating ways to 
eliminate this chattering completely. As has been shown in the previous section, the 
chattering is the result of the correction torques attempting to counterbalance the effect of 
errors in the manipulator parameters. If the manipulator model is precisely known, the 
correction torques are reduced to zero and the controller becomes an inverse dynamics. 
This can be achieved by off line identification tests. Also it has been shown that in practice 
most of the manipulator parameters can be measured or estimated beforehand and only the 
parameters that are load dependent are unknown [74]. Using this fact, simulations with on 


line recursive least squares estimation of the load alone are currently underway. 
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APPENDIX 
DYNAMICS OF THE TWO LINKS PLANAR MECHANICAL MANIPULATOR 


A. INTRODUCTION 

The two revolute joints planar mechanical manipulator shown in Figure A.1 is used as 
the basis for our simulations throughout this study. In this Appendix, the dynamic 
equations describing the motion of this physical system are derived using the Lagrangian 


Euler equations of Chapter 2. 


B. NOTATION 
The same notation and conventions as established in Chapter 2 are also employed here. 
In addition, for 2 = 1, 2, the following variables are used to denote: 
0, the joint angle, which also serves as the generalized coordinate; 
m, the mass of link 2; 
i. the length of link 2; 
oe the distance from the proximate joint to the center of mass of link 2; and 


I. the moment of inertia of link 1 about the axis Z 


C. EQUATIONS OF MOTIONS 
Equation (2.15) of Chapter 2 can be used to derive the kinetic energy kK, of link 7 This 
equation can also be broken down into a translational and a rotational parts as: 
me i wie 
R= ay ™ Vogt (At) 
where v a denotes the linear velocity of the center of mass of link 7 and W, the angular 


velocity of link 7 about Z 
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Figure A.1: Atwo link Mechanical Manipulator 
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The total kinetic energy K of the manipulator is then: 


2 
K=EK. (A.2) 
t=1 0 


The total potential energy is found using equation (2.20) of Chapter 2 as: 


2 
where C, is the position of the center of mass of link 7 and g the gravity row vector. 


From Figure A.1, 





—ly a, sin(@,) 
Yo = ‘og a, cos(@, ) (A.4) 
0 
— {1 sin (8, ) +- 9 Sin(@, +4 )} a — 9 Sin(@, +4.) 8, 
) ia — {1 cos (8,) + 19 cos(#,+8)} 4, + Lio cos(#, +4.) 0. (A.5) 
0 
0 
w= | (A.6) 
a 
and 
0 
Wo= | 0 (A.7) 
0, +4, 
Therefore, 
a 2 
K,=3- m, 1,8, (A.8) 


2 


al . iy 2 


2 
we 
£4 








Bae 
2 
+ == My 1g COS(8,+85) {1,cos(8,) + 2 cos(9,+4,)} 4, 8 
“5 Mo le sin(#, +85) {/sin(9, ) +: 2 sin(9, +85)} 0,8, 
o 


Diya ee: 
x47 Mo by (8, + 9) (A.9) 
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l l 
: ashi 
—— (m + 2Mp) g —x— sin(4,) M5 sin(@, +4,) (A.10) 
l l 
where I. and [5 have been replaced by - and = respectively. 





Without loss in generality, we assume ! a ly = |, and perform the operations in the 


Lagrangian equations. After rearranging, we obtain the following actuators torques: 





. a 
7) [ar S12] 1), [aan “are "12 “22 7 | Ten 
iy 291 899 | | % Yo11 Ya12 Yoo Yoo9 | | %2 %) oo 
“2 
4 
where 
l 4 
ary =+m,f+—4 mf + mt cos( Gp) (An) 
1 l 
a9 =-t mf ++ my cos(4,) (A.13) 
1 l 
ao) = 37 Mg oe a My f cos(@,) (A.14) 
1 
“ee iB 2 f (A.15) 
“ili (A.16) 
¥y19 =— Mol sin(B,) (A.17) 
Vio, = 0 (A.18) 
| 
Vi99 =~ 77 My f sin( @5) (A.19) 
] | 
Vo] =—g- Myf sin(8,) (A.20) 
ogy (A.21) 
V59] 0 (A.22) 
Vo99 = 0 (A.23) 
m, cos(#, +8) 
G, =8!{—j- cos(,) + my (cos(9,) + —5y—— )} (A.24) 
| 


Equations (A.11) through (A.25) constitute what is known as the inverse dynamics form 


of the equations of motion of the two link mechanical manipulator of Figure A.1. These 
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equations are used in Chapter Three to evaluate the performance of many commonly 
known adaptive control algorithms as applied to robotic manipulators. The reason for this 
choice is that Equations (A.11) through (A.25) are relatively simple enough to keep the 


operations manageable, and yet, representative of the systems under study. 
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